Code for quadcopter honours project