Add function to get head position
Supress debug print out
Add test code to adjust shape pitch, roll, yaw