Implement ROS service to enable motors

A ROS service and coresponding specification EnableMotor.srv has been
implemented.
Stop sending setpoints to sbRIOs that doesnt support it.

Some of the joints is not actuateable, so sending setpoints is a waste
of bandwidth. This has now been fixed, by adding a mask to the setpoints
vector.