Added sketch to test ESCs/motors independently
Read serial device and speed from command line arguments
Added MPU6050 digital low pass filter configuration
Fixed bug in which initial attitude may not be (1, 0, 0, 0)