control_motion now updates internal values based on core_sensors' topics.
Added comments to the control_motion code explaining the behaviours it implements and how it switches between them