Fixed softreset (#132)

Co-authored-by: an4cr0n <[email protected]>

Author: Sonic0

src/DW1000Ng.cpp

@@ -1415,21 +1415,17 @@ namespace DW1000Ng {
 	}
 
 	void softwareReset() {
-		/* Sets SYS_XTI_CLOCK and write PMSC to all zero */
+		/* Disable sequencing and go to state "INIT" - (a) Sets SYSCLKS to 01 */
 		_disableSequencing();
 		/* Clear AON and WakeUp configuration */
 		_writeToRegister(AON, AON_WCFG_SUB, 0x00, LEN_AON_WCFG);
 		_writeToRegister(AON, AON_CFG0_SUB, 0x00, LEN_AON_CFG0);
 		_writeToRegister(AON, AON_CTRL_SUB, 0x02, LEN_AON_CTRL);
-		/* Reset TX,RX and PMSC */
-		byte pmscctrl0[LEN_PMSC_CTRL0];
-		_readBytes(PMSC, PMSC_CTRL0_SUB, pmscctrl0, LEN_PMSC_CTRL0);
-		pmscctrl0[3] = 0x00;
-		_writeBytesToRegister(PMSC, PMSC_CTRL0_SUB, pmscctrl0, LEN_PMSC_CTRL0);
-		delay(5);
-		/* Reset to all one softwareReset. Clock remain to SYS_XTI_CLOCK */
-		pmscctrl0[3] = 0xF0;
-		_writeBytesToRegister(PMSC, PMSC_CTRL0_SUB, pmscctrl0, LEN_PMSC_CTRL0);
+		/* (b) Clear SOFTRESET to all zero’s */
+		_writeToRegister(PMSC, PMSC_SOFTRESET_SUB, 0x00, LEN_PMSC_SOFTRESET);
+		delay(1);
+		/* (c) Set SOFTRESET to all ones */
+		_writeToRegister(PMSC, PMSC_SOFTRESET_SUB, 0xF0, LEN_PMSC_SOFTRESET);
 	}
 
 	/* ###########################################################################

src/DW1000NgRegisters.hpp

@@ -319,17 +319,18 @@ constexpr uint16_t LEN_AON_CFG1 = 2;
 // PMSC
 constexpr uint16_t PMSC = 0x36;
 constexpr uint16_t PMSC_CTRL0_SUB = 0x00;
+constexpr uint16_t GPDCE_BIT = 18;
+constexpr uint16_t KHZCLKEN_BIT = 23;
+constexpr uint16_t PMSC_SOFTRESET_SUB = 0x03;
 constexpr uint16_t PMSC_CTRL1_SUB = 0x04;
+constexpr uint16_t ATXSLP_BIT = 11;
+constexpr uint16_t ARXSLP_BIT = 12;
 constexpr uint16_t PMSC_LEDC_SUB = 0x28;
+constexpr uint16_t BLNKEN = 8;
 constexpr uint16_t LEN_PMSC_CTRL0 = 4;
+constexpr uint16_t LEN_PMSC_SOFTRESET = 1;
 constexpr uint16_t LEN_PMSC_CTRL1 = 4;
 constexpr uint16_t LEN_PMSC_LEDC = 4;
-constexpr uint16_t GPDCE_BIT = 18;
-constexpr uint16_t KHZCLKEN_BIT = 23;
-constexpr uint16_t BLNKEN = 8;
-
-constexpr uint16_t ATXSLP_BIT = 11;
-constexpr uint16_t ARXSLP_BIT = 12;
 
 // TX_ANTD Antenna delays
 constexpr uint16_t TX_ANTD = 0x18;