added controller config for gazebo and moveit, still have to tune gazebo controller gains