Intermediate commit - preparing for standalone build
Motors control skeleton
Copter control functionality, buggy