drv_iic_front.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162
  1. #include "drv_iic_front.h"
  2. #include "nrf_delay.h"
  3. #define delayTime 1
  4. static void IIC_FRONT_Start(void)
  5. {
  6. IIC_FRONT_SDA_SET;
  7. IIC_FRONT_SCL_SET;
  8. nrf_delay_us(5);
  9. IIC_FRONT_SDA_CLR;
  10. nrf_delay_us(5);
  11. IIC_FRONT_SCL_CLR;
  12. }
  13. static void IIC_FRONT_Stop(void)
  14. {
  15. IIC_FRONT_SCL_CLR;
  16. IIC_FRONT_SDA_CLR;
  17. nrf_delay_us(5);
  18. IIC_FRONT_SCL_SET;
  19. IIC_FRONT_SDA_SET;
  20. nrf_delay_us(5);
  21. }
  22. static void IIC_FRONT_ACK(void)
  23. {
  24. IIC_FRONT_SCL_CLR;
  25. nrf_delay_us(1);
  26. IIC_FRONT_SDA_CLR;
  27. nrf_delay_us(1);
  28. IIC_FRONT_SCL_SET;
  29. nrf_delay_us(1);
  30. IIC_FRONT_SCL_CLR;
  31. }
  32. static void IIC_FRONT_NoACK(void)
  33. {
  34. IIC_FRONT_SCL_CLR;
  35. IIC_FRONT_SDA_SET;
  36. nrf_delay_us(1);
  37. IIC_FRONT_SCL_SET;
  38. nrf_delay_us(1);
  39. IIC_FRONT_SCL_CLR;
  40. }
  41. static bool IIC_FRONT_WaitACK(void)
  42. {
  43. uint8_t tim = 0;
  44. // IIC_FRONT_SCL_CLR;
  45. IIC_FRONT_SDA_SET;
  46. nrf_delay_us(1);
  47. IIC_FRONT_SCL_SET;
  48. // nrf_delay_us(1);
  49. while(IIC_FRONT_SDA_READ){
  50. if(++tim>=50){
  51. IIC_FRONT_Stop();
  52. return false;
  53. }
  54. nrf_delay_us(1);
  55. }
  56. IIC_FRONT_SCL_CLR;
  57. return true;
  58. }
  59. static void IIC_FRONT_SendByte(uint8_t _byte)
  60. {
  61. uint8_t i = 0;
  62. for (i=0; i<8; i++){
  63. IIC_FRONT_SCL_CLR;
  64. // nrf_delay_us(1);
  65. if (_byte&0x80) IIC_FRONT_SDA_SET;
  66. else IIC_FRONT_SDA_CLR;
  67. _byte <<= 1;
  68. IIC_FRONT_SCL_SET;
  69. }
  70. IIC_FRONT_SCL_CLR;
  71. }
  72. static uint8_t IIC_FRONT_RecByte(void)
  73. {
  74. uint8_t i = 0;
  75. uint8_t rec_byte;
  76. IIC_FRONT_SDA_SET;
  77. for (i=0; i<8; i++){
  78. rec_byte <<= 1;
  79. IIC_FRONT_SCL_CLR;
  80. IIC_FRONT_SCL_CLR;
  81. IIC_FRONT_SCL_CLR;
  82. IIC_FRONT_SCL_CLR;
  83. // nrf_delay_us(1);
  84. IIC_FRONT_SCL_SET;
  85. // nrf_delay_us(1);
  86. if (IIC_FRONT_SDA_READ) rec_byte |= 0x01;
  87. }
  88. IIC_FRONT_SCL_CLR;
  89. return rec_byte;
  90. }
  91. /********************************************/
  92. bool IIC_FRONT_WriteBytes(uint8_t add,uint8_t reg,uint8_t* p,uint8_t len)
  93. {
  94. uint8_t i = 0;
  95. IIC_FRONT_Start();
  96. IIC_FRONT_SendByte(add);
  97. if(!IIC_FRONT_WaitACK()) return false;
  98. IIC_FRONT_SendByte(reg);
  99. if(!IIC_FRONT_WaitACK()) return false;
  100. for(i=0;i<len;i++){
  101. IIC_FRONT_SendByte(p[i]);
  102. if(!IIC_FRONT_WaitACK()) return false;
  103. }
  104. IIC_FRONT_Stop();
  105. return true;
  106. }
  107. bool IIC_FRONT_ReadBytes(uint8_t add,uint8_t reg,uint8_t* p,uint8_t len)
  108. {
  109. uint8_t i = 0;
  110. IIC_FRONT_Start();
  111. IIC_FRONT_SendByte(add);
  112. if(!IIC_FRONT_WaitACK()) return false;
  113. IIC_FRONT_SendByte(reg);
  114. if(!IIC_FRONT_WaitACK()) return false;
  115. IIC_FRONT_Start();
  116. IIC_FRONT_SendByte(add+1);
  117. if(!IIC_FRONT_WaitACK()) return false;
  118. for(i=0;i<len-1;i++){
  119. p[i] = IIC_FRONT_RecByte(); IIC_FRONT_ACK();
  120. }
  121. p[i] = IIC_FRONT_RecByte(); IIC_FRONT_NoACK();
  122. IIC_FRONT_Stop();
  123. return true;
  124. }
  125. void IIC_FRONT_Init(void)
  126. {
  127. nrf_gpio_cfg(
  128. PIN_QMC_LSM_FRONT_SCL,
  129. NRF_GPIO_PIN_DIR_OUTPUT,
  130. NRF_GPIO_PIN_INPUT_DISCONNECT,
  131. NRF_GPIO_PIN_NOPULL,
  132. NRF_GPIO_PIN_S0S1,
  133. NRF_GPIO_PIN_NOSENSE);
  134. nrf_gpio_cfg_watcher(PIN_QMC_LSM_FRONT_SCL);
  135. nrf_gpio_pin_set(PIN_QMC_LSM_FRONT_SCL);
  136. nrf_gpio_cfg(
  137. PIN_QMC_LSM_FRONT_SDA,
  138. NRF_GPIO_PIN_DIR_OUTPUT,
  139. NRF_GPIO_PIN_INPUT_DISCONNECT,
  140. NRF_GPIO_PIN_NOPULL,
  141. NRF_GPIO_PIN_S0S1,
  142. NRF_GPIO_PIN_NOSENSE);
  143. nrf_gpio_cfg_watcher(PIN_QMC_LSM_FRONT_SDA);
  144. nrf_gpio_pin_set(PIN_QMC_LSM_FRONT_SDA);
  145. }