Fixed -j1 topological message generation error.
Added appropriate comments to all new files.
Fixed BBB_I2C tools write funtion memory leak.
Tested and working for single_imu case.

Signed-off-by: Jake Reher <jake.reher@gmail.com>