Code for lateral control.

Helicopter doesn't successfully fly at this stage, but all variables are being calculated and transmitted to simulator.