controller.c: fixed formula to use degrees instead of radians