First version of code

The quadcopter can already be built with this code