body yaw debugging (commented out)
Merge remote-tracking branch 'upstream/master'
Merge remote-tracking branch 'upstream/master'
Added eulerToOrthonormals function for Brad in Util.cpp, sample execution at start of main.
Merge pull request #79 from PhilipRosedale/master

Created eulerToOrthonormals function to (hopefully) help Brad