compiles and runs on vm until libsoc fails due to missing hardware-->test on BBB, printfs need replacing with ros_error or _info