/source/DW1000/v1/alld_dw1000_v1.c - Diff - AMiRo-OS - Research for Cognitive Interaction

Revision 33f54213 source/DW1000/v1/alld_dw1000_v1.c

+     *
      */
     #include <alld_DW1000.h>
     #if (defined(AMIROLLD_CFG_DW1000) && (AMIROLLD_CFG_DW1000 == 1)) || defined(__DOXYGEN__)
     #include <v1/alld_dw1000_regs_v1.h>
     #include <aos_thread.h>
     #include <assert.h>
     #include <string.h>
-...
     #include <math.h>
     // HW dependent implementation (see bottom of file)
     static int writetospi(uint16_t headerLength,
                    const	uint8_t *headerBuffer,
                    uint32_t bodyLength,
                    const	uint8_t *bodyBuffer);
     static int readfromspi(uint16_t headerLength,
                     const uint8_t *headerBuffer,
                     uint32_t readlength,
                     uint8_t *readBuffer);
     // Defines for enable_clocks function
     #define FORCE_SYS_XTI  0
     #define ENABLE_ALL_SEQ 1
-...
     #define FCTRL_LEN_MAX 2
     /**
      * Move to the header file <alld_dw1000_v1.h>
     */
     //#define NUM_BR 3
     //#define NUM_PRF 2
     //#define NUM_PACS 4
     //#define NUM_BW 2            //2 bandwidths are supported
     //#define NUM_SFD 2           //supported number of SFDs - standard = 0, non-standard = 1
     //#define NUM_CH 6            //supported channels are 1, 2, 3, 4, 5, 7
     //#define NUM_CH_SUPPORTED 8  //supported channels are '0', 1, 2, 3, 4, 5, '6', 7
     //#define PCODES 25           //supported preamble codes
     typedef struct {
         uint32_t lo32;
         uint16_t target[NUM_PRF];
-...
     #define VTEMP_ADDRESS  (0x09)
     #define XTRIM_ADDRESS  (0x1E)
     //int dwt_initialise(const uint16_t config, DW1000Driver* drv)
     int dwt_initialise(const uint16_t config)  // TODO:
     int dwt_initialise(const uint16_t config, DW1000Driver* drv)
     //int dwt_initialise(const uint16_t config)  // TODO:
+    {
         uint16_t otp_addr = 0;
         uint32_t ldo_tune = 0;
-...
         pdw1000local->cbRxTo = NULL;
         pdw1000local->cbRxErr = NULL;
     //    pdw1000local->driver = drv;  // TODO:
         pdw1000local->driver = drv;  // TODO:
         // Read and validate device ID return -1 if not recognised
         if (DWT_DEVICE_ID != dwt_readdevid()) // MP IC ONLY (i.e. DW1000) FOR THIS CODE
-...
+        }
         // Write it to the SPI
     //    _alld_dw1000_writespi(cnt,header,length,buffer);
         writetospi(cnt,header,length,buffer);  // TODO
         writetospi(cnt,header,length,buffer);
     } // end dwt_writetodevice()
     /*! ------------------------------------------------------------------------------------------------------------------
-...
+        }
         // Do the read from the SPI
     //    _alld_dw1000_readspi(cnt, header, length, buffer);  // result is stored in the buffer
         readfromspi(cnt, header, length, buffer);  // TODO:
         readfromspi(cnt, header, length, buffer);
     } // end dwt_readfromdevice()
-...
+     *
      ****************************************************************************************************************************************************/
     /*
      * DW1000 Hardware dependent functions: SPI, EXTI
      */
     /****************************************************************************//**
+     *
      * 	alld_dw1000.c					SPI Section
+     *
      *******************************************************************************/
     /*! ------------------------------------------------------------------------------------------------------------------
      * Function: writetospi()
-...
      * returns 0 for success, or -1 for error
      */
     #pragma GCC optimize ("O3")
     int writetospi(uint16_t headerLength,
     static int writetospi(uint16_t headerLength,
                    const	uint8_t *headerBuffer,
                    uint32_t bodyLength,
                    const	uint8_t *bodyBuffer)
+    {
         port_SPIx_clear_chip_select();
         uint8_t buffer[bodyLength + 3];
         memcpy(buffer, headerBuffer, headerLength); //copy data to buffer
         memcpy(&buffer[headerLength], bodyBuffer, bodyLength); //copy data to buffer
-...
                         buffer,
                         bodyLength + headerLength); // send header and data
         port_SPIx_set_chip_select();
         return 0;
     } // end writetospi()
     /*! ------------------------------------------------------------------------------------------------------------------
      * Function: readfromspi()
+     *
-...
      * or returns -1 if there was an error
      */
     #pragma GCC optimize ("O3")
     int readfromspi(uint16_t headerLength,
     static int readfromspi(uint16_t headerLength,
                     const uint8_t *headerBuffer,
                     uint32_t readlength,
                     uint8_t *readBuffer)
+    {
         apalSPITransmitAndReceive(&MODULE_HAL_SPI_UWB,
         apalSPITransmitAndReceive(&MODULE_HAL_SPI_UWB, // TODO: "pdw1000local->driver->spid" fails two spi configs
                                   headerBuffer,
                                   readBuffer,
                                   headerLength,
-...
+     *
      * returns the state of the DW1000 interrupt
      */
     decaIrqStatus_t decamutexon(void)
     decaIrqStatus_t decamutexon(void)
+    {
         decaIrqStatus_t s = port_GetEXT_IRQStatus();
         if(s) {
             port_DisableEXT_IRQ(); //disable the external interrupt line
+        }
         return s ;   // return state before disable, value is used to re-enable in decamutexoff call
       decaIrqStatus_t s = port_GetEXT_IRQStatus();
       if(s) {
         port_DisableEXT_IRQ(); //disable the external interrupt line
+      }
       return s ;   // return state before disable, value is used to re-enable in decamutexoff call
+    }
     /*! ------------------------------------------------------------------------------------------------------------------
-...
      */
     void decamutexoff(decaIrqStatus_t s)
+    {
     //    (void) s;
         if(s) { //need to check the port state as we can't use level sensitive interrupt on the STM ARM
           port_EnableEXT_IRQ();
+        }
     //    return;
     //  (void) s;
       if(s) { //need to check the port state as we can't use level sensitive interrupt on the STM ARM
         port_EnableEXT_IRQ();
+      }
       return;
+    }
-...
     void deca_sleep(unsigned int time_ms)
+    {
         aosThdMSleep(time_ms);
       aosThdMSleep(time_ms);
+    }
     void Sleep(unsigned int time_ms)
+    {
         aosThdMSleep(time_ms);
       aosThdMSleep(time_ms);
+    }
     void port_set_dw1000_slowrate(){ // replaced with setHighSpeed_SPI(bool speedValue) implemented in module.c
         return;
+    }
     void port_set_dw1000_fastrate(){ // replaced with setHighSpeed_SPI(bool speedValue) implemented in module.c
         return;
+    }
     void port_wakeup_dw1000_fast(){ // NOT SUPPORTED
         return;
       return;
+    }
     uint32_t portGetTickCnt(){
         return chVTGetSystemTimeX();
       return chVTGetSystemTimeX();
+    }
     //inline uint32_t portGetTickCnt(){
-...
     void port_DisableEXT_IRQ(void){
        nvicDisableVector(DW1000_EXTI_IRQn);
       nvicDisableVector(DW1000_EXTI_IRQn);
+    }
     void port_EnableEXT_IRQ(void){
         nvicEnableVector(DW1000_EXTI_IRQn, STM32_IRQ_EXTI10_15_PRIORITY);
       nvicEnableVector(DW1000_EXTI_IRQn, STM32_IRQ_EXTI10_15_PRIORITY);
+    }
     ITStatus port_GetEXT_IRQStatus(void){
       ITStatus bitstatus = RESET;
       //  uint32_t enablestatus = 0;
     decaIrqStatus_t port_GetEXT_IRQStatus(void){
       decaIrqStatus_t bitstatus = RESET;
       if(NVIC_GetActive(DW1000_EXTI_IRQn)|| NVIC_GetPendingIRQ(DW1000_EXTI_IRQn)){
         //  if(NVIC_GetPendingIRQ(EXTI15_10_IRQn)){ //if the interrupt is pending (background )
         bitstatus = SET; //Interrupt is active or panding
+      }
       else {
         bitstatus = RESET; //Currently there is no interrupt IRQ
         bitstatus = RESET; //No interrupt IRQ at the moment
+      }
       return bitstatus;
+    }
     #endif /* defined(AMIROLLD_CFG_DW1000) && (AMIROLLD_CFG_DW1000 == 1) */

Also available in: Unified diff