Added control of the time variable and made the head rotate freely
Fixed bug - it was simply the proportional controller not subtracting the center of mass