Adds forward kinematics for head, including get camera basis matrix.
Adds inverse kinematics for head
Adds inverse kinematics for head
Adds testing for kinematics for head. Compiles but carries a segfault in KinematicsDebug.cpp. Do not use head IK/FK yet.