gps setpoints work, trig does not