Sixaxis control: added actions (lights, servos, full stop, take pic) and moving pan&tilt servos with right joystick