Changed message sent and nodes.
Making code more helpful and safe.

Improving the design and documentation.

Replaced tabs with spaces.
utility: Formatted long lines.
nodes: Wrote documentation and doctests.
sensors: moved in the IMU code.
nodes: should comply with graph standard.