Testing vehicle

Working on it
Balanced using just pitch
The quads pitch and throttle
Added pitch and roll to the mixing

Getting it ready to test on the pi
Motor values to the motor

This would help testing it on the pi
Pitch and Roll

Got the pitch and roll working with the quadcopter
Merge branch 'testing' into vehicle