Initial working head-hand tracking configuration. Looks at way-points every 0.3 seconds. In the process of implementing a smoother version, but committing this intermediate stage since it works.