fix torso pitch rotation and imu coords, ssb commits are also included, but these changes will not have any effect
Merge pull request #13 from s-noda/fix_torso_rotation_and_imu_coords

it should be okay. if not, we can just remove the ssb commits. the commits are only a few additional lines.