Added rest of diagnostic packets.
Added ability to actuate jaw from joystick. Added joystick synchronization after long functions. Removed loop time limiter.