Write ros_control controllers for existing joints

[michaelmoritsugu]

Requirements

• Each controller must be able to send commands to and read feedback from physical entities.
• Controllers must be able to manipulate identity entity in Gazebo
• Should use ros_control design. Setting up the RobotHW to use ros_controll requires additional information