FreeRTOS based basic quadcopter firmware for LPC2148