FPGA Quadcopter control algorithm