Drivers, Sensor Fusion and Contoller for Quadcopter on Atmel Xmega128A1U