dw1000: rewritten reset function, now soft reset

Src/dw1000_hal.c

@@ -21,18 +21,19 @@ TaskHandle_t xHandleDW1000HAL  = NULL;
 
 void dw1000Hal_reset(void)
 {
-  GPIO_InitTypeDef GPIO_InitStruct;
-  /*Configure GPIO pin : PD7 */
-  GPIO_InitStruct.Pin = GPIO_PIN_7;
-  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
-  GPIO_InitStruct.Speed = GPIO_SPEED_LOW;
-  GPIO_InitStruct.Pull = GPIO_NOPULL;
-  HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
-  HAL_GPIO_WritePin(GPIOD, GPIO_PIN_7, GPIO_PIN_RESET);
-  GPIO_InitStruct.Pin = GPIO_PIN_7;
-  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
-  GPIO_InitStruct.Pull = GPIO_NOPULL;
-  HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
+	uint32_t subreg;
+	dw1000Hal_readSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
+	subreg |= (1 << 0 );
+	subreg &= ~(1 << 1);
+	dw1000Hal_writeSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
+
+	dw1000Hal_readSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
+	subreg &= ~(15 << 28);
+	dw1000Hal_writeSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
+
+	dw1000Hal_readSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
+	subreg |= (15 << 28);
+	dw1000Hal_writeSubRegister(PMSC_ID,PMSC_CTRL0_OFFSET,(uint8_t*)&subreg,PMSC_CTRL0_LEN);
 }
 
 void dw1000Hal_chipSelect(void)