Split system into modules to improve maintainability. Also, interface all robot-level calls to robotlink module, and specifically the Link class. This should hopefuly smooth out swapping IK/joint movement/pr2_object_manipulation with MoveIt and other Hydro equivalents.