Updated simple_robot_kinematics to work with MoveIt. API IS NOT BACKWARD COMPATIBLE