updated RobotArmControl, now have hand X, Y and Z, with XZ being plane, and Y being color
Working code! used in demo for presentation. Added comments at top