Gazebo now works a little better. Small fixes in driver/camera.

Also, I added 'Body' group in srdf files to be able to control all joints at once in MoveIt!