Tekkotsu: Moving some functions to the header file to allow basic usage (SIFT library) without having to link in all of the kinematics stuff from the rest of the .cc file