Maybe fix omni2 trig