Cleaned up quadcopter.c