Prototype working correctly. Improvements still needed in servo control and video aspect ratio.
Fixed aspect ratio, and added fullscreen key