More RC and OC changes!

The quadcopter flies with this code :)