Update switching code for PMOS: kind of working with SG90.

1 files changed, 2 insertions, 2 deletions

diff --git a/main.c b/main.c
index b708226..326f4ac 100644
--- a/main.c
+++ b/main.c
@@ -76,12 +76,12 @@ static inline void flash_led(void)
 
 static inline void pwr_fpm_servo_on(void)
 {
-	PWR_PORT &= ~((1 << PWR_FPM) | (1 << PWR_SERVO));
+	PWR_PORT |= (1 << PWR_FPM) | (1 << PWR_SERVO);
 }
 
 static inline void pwr_fpm_servo_off(void)
 {
-	PWR_PORT |= (1 << PWR_FPM) | (1 << PWR_SERVO);
+	PWR_PORT &= ~((1 << PWR_FPM) | (1 << PWR_SERVO));
 }
 
 int main(void)