basic input reading done, restructured code

[flok]

• only using 1 thread for reading inputs and updating the controller
• reading the inputs mostly done, gyro and accel missing