Ensure that init_PPS is called before the first call to run().

Author: aentinger

src/Braccio++.cpp

@@ -98,10 +98,10 @@ bool BraccioClass::begin(voidFuncPtr custom_menu)
   pinMode(PIN_FUSB302_INT, INPUT_PULLUP);
   pinMode(RS485_RX_PIN, INPUT_PULLUP);
 
+  _PD_UFP.init_PPS(_i2c_mtx, PPS_V(7.2), PPS_A(2.0));
   _pd_thd.start(mbed::callback(this, &BraccioClass::pd_thread_func));
   attachInterrupt(PIN_FUSB302_INT, braccio_unlock_pd_semaphore_irq, FALLING);
   _pd_timer.attach(braccio_unlock_pd_semaphore, 10ms);
-  _PD_UFP.init_PPS(_i2c_mtx, PPS_V(7.2), PPS_A(2.0));
 
   button_init();
 
@@ -477,7 +477,6 @@ void BraccioClass::pd_thread_func()
     }
     _PD_UFP.run();
     if (_PD_UFP.is_power_ready() && _PD_UFP.is_PPS_ready()) {
-
     }
   }
 }