mkblctrl cleaned up and flown with px4 stack and arducopter

Cleaned up the code, removed unused topics.
This was started in the following order 
mkblctrl
fmu mode_pwm

Looks good.
Arducopter is also working, with only a small modification of the startup script