Change how pressure mode works.

Instead of setting OF we use JG for our setpoint. The I term is limited
to 100000 and resets once the target it hit. The maximum speed we can
control in pressure is 200000