Fix various compilation issue
Merge branch 'offboard2' of https://github.com/elikos/Firmware into offboard2