Add Camera pan/tilt support. Fix serial comm logic