drv_iic_04.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201
  1. #include "drv_iic_04.h"
  2. #include "nrf_delay.h"
  3. #define delayTime 1
  4. static void IIC_04_Start(void)
  5. {
  6. IIC_04_SDA_SET;
  7. IIC_04_SCL_SET;
  8. nrf_delay_us(5);
  9. IIC_04_SDA_CLR;
  10. nrf_delay_us(5);
  11. IIC_04_SCL_CLR;
  12. }
  13. static void IIC_04_Stop(void)
  14. {
  15. IIC_04_SCL_CLR;
  16. IIC_04_SDA_CLR;
  17. nrf_delay_us(5);
  18. IIC_04_SCL_SET;
  19. IIC_04_SDA_SET;
  20. nrf_delay_us(5);
  21. }
  22. static void IIC_04_ACK(void)
  23. {
  24. IIC_04_SCL_CLR;
  25. nrf_delay_us(1);
  26. IIC_04_SDA_CLR;
  27. nrf_delay_us(1);
  28. IIC_04_SCL_SET;
  29. nrf_delay_us(1);
  30. IIC_04_SCL_CLR;
  31. }
  32. static void IIC_04_NoACK(void)
  33. {
  34. IIC_04_SCL_CLR;
  35. IIC_04_SDA_SET;
  36. nrf_delay_us(1);
  37. IIC_04_SCL_SET;
  38. nrf_delay_us(1);
  39. IIC_04_SCL_CLR;
  40. }
  41. static bool IIC_04_WaitACK(void)
  42. {
  43. uint8_t tim = 0;
  44. // IIC_04_SCL_CLR;
  45. IIC_04_SDA_SET;
  46. nrf_delay_us(1);
  47. IIC_04_SCL_SET;
  48. // nrf_delay_us(1);
  49. while(IIC_04_SDA_READ){
  50. if(++tim>=50){
  51. IIC_04_Stop();
  52. return false;
  53. }
  54. nrf_delay_us(1);
  55. }
  56. IIC_04_SCL_CLR;
  57. return true;
  58. }
  59. static void IIC_04_SendByte(uint8_t _byte)
  60. {
  61. uint8_t i = 0;
  62. for (i=0; i<8; i++){
  63. IIC_04_SCL_CLR;
  64. // nrf_delay_us(1);
  65. if (_byte&0x80) IIC_04_SDA_SET;
  66. else IIC_04_SDA_CLR;
  67. _byte <<= 1;
  68. IIC_04_SCL_SET;
  69. // nrf_delay_us(1);
  70. }
  71. IIC_04_SCL_CLR;
  72. }
  73. static uint8_t IIC_04_RecByte(void)
  74. {
  75. uint8_t i = 0;
  76. uint8_t rec_byte;
  77. IIC_04_SDA_SET;
  78. for (i=0; i<8; i++){
  79. rec_byte <<= 1;
  80. IIC_04_SCL_CLR;
  81. IIC_04_SCL_CLR;
  82. IIC_04_SCL_CLR;
  83. IIC_04_SCL_CLR;
  84. // nrf_delay_us(1);
  85. IIC_04_SCL_SET;
  86. // nrf_delay_us(1);
  87. if (IIC_04_SDA_READ) rec_byte |= 0x01;
  88. }
  89. IIC_04_SCL_CLR;
  90. return rec_byte;
  91. }
  92. /********************************************/
  93. bool IIC_04_WriteBytes(uint8_t add,uint8_t reg,uint8_t* p,uint8_t len)
  94. {
  95. uint8_t i = 0;
  96. IIC_04_Start();
  97. IIC_04_SendByte(add);
  98. if(!IIC_04_WaitACK()) return false;
  99. IIC_04_SendByte(reg);
  100. if(!IIC_04_WaitACK()) return false;
  101. for(i=0;i<len;i++){
  102. IIC_04_SendByte(p[i]);
  103. if(!IIC_04_WaitACK()) return false;
  104. }
  105. IIC_04_Stop();
  106. return true;
  107. }
  108. bool IIC_04_ReadBytes(uint8_t add,uint8_t reg,uint8_t* p,uint8_t len)
  109. {
  110. uint8_t i = 0;
  111. IIC_04_Start();
  112. IIC_04_SendByte(add);
  113. if(!IIC_04_WaitACK()) return false;
  114. IIC_04_SendByte(reg);
  115. if(!IIC_04_WaitACK()) return false;
  116. IIC_04_Start();
  117. IIC_04_SendByte(add+1);
  118. if(!IIC_04_WaitACK()) return false;
  119. for(i=0;i<len-1;i++){
  120. p[i] = IIC_04_RecByte(); IIC_04_ACK();
  121. }
  122. p[i] = IIC_04_RecByte(); IIC_04_NoACK();
  123. IIC_04_Stop();
  124. return true;
  125. }
  126. void IIC_04_Init(void)
  127. {
  128. #if SHAREPIN_CONFIG == 1
  129. nrf_gpio_cfg(
  130. PIN_SCL_1,
  131. NRF_GPIO_PIN_DIR_OUTPUT,
  132. NRF_GPIO_PIN_INPUT_DISCONNECT,
  133. NRF_GPIO_PIN_NOPULL,
  134. NRF_GPIO_PIN_H0D1,
  135. NRF_GPIO_PIN_NOSENSE);
  136. nrf_gpio_cfg_watcher(PIN_SCL_1);
  137. nrf_gpio_pin_set(PIN_SCL_1);
  138. nrf_gpio_cfg(
  139. PIN_SDA_1,
  140. NRF_GPIO_PIN_DIR_OUTPUT,
  141. NRF_GPIO_PIN_INPUT_DISCONNECT,
  142. NRF_GPIO_PIN_NOPULL,
  143. NRF_GPIO_PIN_H0D1,
  144. NRF_GPIO_PIN_NOSENSE);
  145. nrf_gpio_cfg_watcher(PIN_SDA_1);
  146. nrf_gpio_pin_set(PIN_SDA_1);
  147. #elif SHAREPIN_CONFIG == 2
  148. nrf_gpio_cfg_output(PIN_QMC6310_EN_01);
  149. nrf_gpio_pin_write(PIN_QMC6310_EN_01,1);
  150. nrf_gpio_cfg_output(PIN_QMC6310_SCL_01);
  151. nrf_gpio_cfg_watcher(PIN_QMC6310_SCL_01);
  152. nrf_gpio_pin_set(PIN_QMC6310_SCL_01);
  153. nrf_gpio_cfg_output(PIN_QMC6310_SDA_01);
  154. nrf_gpio_cfg_watcher(PIN_QMC6310_SDA_01);
  155. nrf_gpio_pin_set(PIN_QMC6310_SDA_01);
  156. #elif SHAREPIN_CONFIG == 3
  157. nrf_gpio_cfg(
  158. PIN_SDA_BACK,
  159. NRF_GPIO_PIN_DIR_OUTPUT,
  160. NRF_GPIO_PIN_INPUT_DISCONNECT,
  161. NRF_GPIO_PIN_NOPULL,
  162. NRF_GPIO_PIN_S0S1,
  163. NRF_GPIO_PIN_NOSENSE);
  164. nrf_gpio_cfg_watcher(PIN_SDA_BACK);
  165. nrf_gpio_pin_set(PIN_SDA_BACK);
  166. nrf_gpio_cfg(
  167. PIN_SCL_MAG,
  168. NRF_GPIO_PIN_DIR_OUTPUT,
  169. NRF_GPIO_PIN_INPUT_DISCONNECT,
  170. NRF_GPIO_PIN_NOPULL,
  171. NRF_GPIO_PIN_S0S1,
  172. NRF_GPIO_PIN_NOSENSE);
  173. nrf_gpio_cfg_watcher(PIN_SCL_MAG);
  174. nrf_gpio_pin_set(PIN_SCL_MAG);
  175. #endif
  176. }