Moveit config (and bugfix)

A couple of things in the urdf prevent from creating a moveit config for the robot. I also added one for completeness