Rerganizing Control Panel handles

Tried to reorganize control panel handles into a logical fashion.
Redefined handles.robot_arm to find the arm in the robot's links.
Code Cleaning