SC7A20: Fix boot register

Author: StarGate01

src/drivers/SC7A20.cpp

@@ -1,6 +1,7 @@
 #include <libraries/delay/nrf_delay.h>
 #include "drivers/SC7A20.h"
 #include "drivers/SC7A20/SC7A20_registers.h"
+#include <task.h>
 
 using namespace Pinetime::Drivers;
 
@@ -18,7 +19,10 @@ void SC7A20::Init() {
 
   // Reset internal memory
   uint8_t data = CTRL_REG5_BOOT;
-  Write(CTRL_REG2, &data, 1);
+  Write(CTRL_REG5, &data, 1);
+  vTaskDelay(5);
+  data = 0;
+  Write(CTRL_REG5, &data, 1);
 
   // Read Chip ID
   Read(WHO_AM_I, &data, 1);