Simulator Changed Model, the data place of wanted positions to submarine
Changed the can_link to bbb protocol to speed it up (the header is now 5 bytes long instead of 8), no changes to code using this project should be needed.
changed BBB_CAN for stress testing of the can link
Changed can_link code so that receiving commands from bbb has higher priority than receiving on the can bus
minor change to  BBB_CAN
Added a makefile inside the bbb_can folder, it seems to work
Wrote a test program for the IMU
Wrote a test program for the IMU