Compass Control done

The control works with dummy module
to test with real coordinates.