ROS Control working in simulation
Robot is moving.. Code needs cleaning