spi_interface.cpp

00001 #include "ToF_I2C.h"
00002 #include "spi_interface.h"
00003 
00004 /* This file is an interface between the c files and the mbed cpp files. */
00005 
00006  int v53l1x_i2c_write_if(uint8_t* pBuffer, uint8_t DeviceAddr, uint16_t RegisterAddr,
00007                   uint16_t NumByteToWrite) 
00008 {
00009     
00010       static ToF_DevI2C *dev_I2C = new ToF_DevI2C(D14, D15);
00011       
00012       dev_I2C->frequency(400000);
00013       
00014      // printf("v53l1x_i2c_write_if %d\n",NumByteToWrite);
00015       int status = dev_I2C->ToF_i2c_write(pBuffer, DeviceAddr, RegisterAddr, NumByteToWrite);     
00016      
00017       if(status)
00018       {
00019           delete dev_I2C;   
00020           return -1;
00021       }     
00022        
00023       return status;       
00024 }
00025 
00026 
00027 
00028  int v53l1x_i2c_read_if(uint8_t* pBuffer, uint8_t DeviceAddr, uint16_t RegisterAddr,
00029                   uint16_t NumByteToRead) 
00030 {
00031             
00032     
00033       static ToF_DevI2C *dev_I2C = new ToF_DevI2C(D14, D15);
00034       if (dev_I2C == NULL)
00035       {
00036                       printf("v53l1x_i2c_read_if  no pointer%d\n",NumByteToRead);
00037       }
00038       dev_I2C->frequency(400000);
00039     //        printf("v53l1x_i2c_read_if %d\n",NumByteToRead);
00040       int status = dev_I2C->ToF_i2c_read(pBuffer, DeviceAddr, RegisterAddr, NumByteToRead);   
00041     //        printf("v53l1x_i2c_read_if %d %d %d %d %d\n",status, DeviceAddr, RegisterAddr,NumByteToRead ,pBuffer[0]);    
00042      // delete dev_I2C;    
00043                        
00044       return status;       
00045 }
00046 
00047 
00048 int GetTickCount(
00049     uint32_t *ptick_count_ms)
00050 {
00051 
00052     /* Returns current tick count in [ms] */
00053 
00054     int status  = 0;
00055 
00056     //*ptick_count_ms = timeGetTime();
00057     *ptick_count_ms = us_ticker_read() / 1000;
00058 
00059     return status;
00060 }