PikaStdDevice_SPI.c 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221
  1. #include "PikaStdDevice_SPI.h"
  2. #include "PikaStdDevice_common.h"
  3. void PikaStdDevice_SPI___init__(PikaObj* self) {
  4. obj_setInt(self, "baudRate", 1000);
  5. obj_setInt(self, "id", 0);
  6. obj_setStr(self, "name", "SOFT");
  7. obj_setInt(self, "phase", 0);
  8. obj_setStr(self, "MISOpin", "none");
  9. obj_setStr(self, "MOSIpin", "none");
  10. obj_setStr(self, "SCKpin", "none");
  11. obj_setInt(self, "polarity", 0);
  12. obj_setPtr(self, "pika_dev", NULL);
  13. }
  14. static pika_dev* _get_dev(PikaObj* self) {
  15. pika_dev* dev = PIKA_HAL_OBJ2DEV(self);
  16. if (NULL != dev) {
  17. return dev;
  18. }
  19. char* name = obj_getStr(self, "name");
  20. if (0 == strcmp(name, "SOFT")) {
  21. dev = pika_hal_open(PIKA_HAL_SOFT_SPI, name);
  22. pika_debug("Open soft spi %s\r\n", name);
  23. } else {
  24. dev = pika_hal_open(PIKA_HAL_SPI, name);
  25. pika_debug("Open spi %s\r\n", name);
  26. }
  27. if (NULL == dev) {
  28. __platform_printf("Error: open IIC '%s' failed.\r\n",
  29. obj_getStr(self, "name"));
  30. return NULL;
  31. }
  32. obj_setPtr(self, "pika_dev", dev);
  33. return dev;
  34. }
  35. void PikaStdDevice_SPI_disable(PikaObj* self) {
  36. pika_dev* dev = _get_dev(self);
  37. if (NULL == dev) {
  38. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  39. obj_getStr(self, "name"));
  40. return;
  41. }
  42. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_DISABLE);
  43. }
  44. void PikaStdDevice_SPI_enable(PikaObj* self) {
  45. pika_dev* dev = _get_dev(self);
  46. if (NULL == dev) {
  47. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  48. obj_getStr(self, "name"));
  49. return;
  50. }
  51. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_ENABLE);
  52. }
  53. void PikaStdDevice_SPI_write(PikaObj* self, char* data) {
  54. pika_dev* dev = _get_dev(self);
  55. if (NULL == dev) {
  56. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  57. obj_getStr(self, "name"));
  58. return;
  59. }
  60. pika_hal_write(dev, data, strlen(data));
  61. }
  62. void PikaStdDevice_SPI_writeBytes(PikaObj* self, uint8_t* data, int length) {
  63. pika_dev* dev = _get_dev(self);
  64. if (NULL == dev) {
  65. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  66. obj_getStr(self, "name"));
  67. return;
  68. }
  69. pika_hal_write(dev, data, length);
  70. }
  71. char* PikaStdDevice_SPI_read(PikaObj* self, int length) {
  72. pika_dev* dev = _get_dev(self);
  73. if (NULL == dev) {
  74. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  75. obj_getStr(self, "name"));
  76. return NULL;
  77. }
  78. char* data = (char*)pikaMalloc(length + 1);
  79. if (NULL == data) {
  80. pika_platform_printf("Error: SPI read failed, no memory.\r\n");
  81. return NULL;
  82. }
  83. int ret = pika_hal_read(dev, data, length);
  84. if (ret < 0) {
  85. pikaFree(data, length + 1);
  86. return NULL;
  87. }
  88. data[length] = '\0';
  89. char* res = obj_cacheStr(self, data);
  90. pikaFree(data, length + 1);
  91. return res;
  92. }
  93. Arg* PikaStdDevice_SPI_readBytes(PikaObj* self, int length) {
  94. pika_dev* dev = _get_dev(self);
  95. if (NULL == dev) {
  96. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  97. obj_getStr(self, "name"));
  98. return NULL;
  99. }
  100. uint8_t* data = (uint8_t*)pikaMalloc(length);
  101. if (NULL == data) {
  102. pika_platform_printf("Error: SPI read failed, no memory.\r\n");
  103. return NULL;
  104. }
  105. int ret = pika_hal_read(dev, data, length);
  106. if (ret < 0) {
  107. pikaFree(data, length);
  108. return NULL;
  109. }
  110. Arg* res = arg_newBytes(data, length);
  111. pikaFree(data, length);
  112. return res;
  113. }
  114. void PikaStdDevice_SPI_setBaudRate(PikaObj* self, int baudRate) {
  115. obj_setInt(self, "baudRate", baudRate);
  116. pika_dev* dev = _get_dev(self);
  117. if (NULL == dev) {
  118. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  119. obj_getStr(self, "name"));
  120. }
  121. pika_hal_SPI_config cfg = {0};
  122. cfg.speed = baudRate;
  123. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_CONFIG, &cfg);
  124. }
  125. void PikaStdDevice_SPI_setId(PikaObj* self, int id) {
  126. obj_setInt(self, "id", id);
  127. Args buffs = {0};
  128. char* name = strsFormat(&buffs, 64, "SPI%d", id);
  129. obj_setName(self, name);
  130. args_deinit(&buffs);
  131. }
  132. void PikaStdDevice_SPI_setName(PikaObj* self, char* name) {
  133. obj_setStr(self, "name", name);
  134. }
  135. void PikaStdDevice_SPI_setPhase(PikaObj* self, int phase) {
  136. obj_setInt(self, "phase", phase);
  137. }
  138. void PikaStdDevice_SPI_setPinMISO(PikaObj* self, char* pin) {
  139. obj_setStr(self, "MISOpin", pin);
  140. pika_dev* dev = _get_dev(self);
  141. if (NULL == dev) {
  142. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  143. obj_getStr(self, "name"));
  144. return;
  145. }
  146. pika_hal_SPI_config cfg = {0};
  147. cfg.MISO = pika_hal_open(PIKA_HAL_GPIO, pin);
  148. if (NULL == cfg.MISO) {
  149. pika_platform_printf("Error: open MISO '%s' failed.\r\n", pin);
  150. return;
  151. }
  152. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_CONFIG, &cfg);
  153. }
  154. void PikaStdDevice_SPI_setPinCS(PikaObj* self, char* pin) {
  155. obj_setStr(self, "CSpin", pin);
  156. pika_dev* dev = _get_dev(self);
  157. if (NULL == dev) {
  158. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  159. obj_getStr(self, "name"));
  160. return;
  161. }
  162. pika_hal_SPI_config cfg = {0};
  163. cfg.CS = pika_hal_open(PIKA_HAL_GPIO, pin);
  164. if (NULL == cfg.CS) {
  165. pika_platform_printf("Error: open CS '%s' failed.\r\n", pin);
  166. return;
  167. }
  168. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_CONFIG, &cfg);
  169. }
  170. void PikaStdDevice_SPI_setPinMOSI(PikaObj* self, char* pin) {
  171. obj_setStr(self, "MOSIpin", pin);
  172. pika_dev* dev = _get_dev(self);
  173. if (NULL == dev) {
  174. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  175. obj_getStr(self, "name"));
  176. return;
  177. }
  178. pika_hal_SPI_config cfg = {0};
  179. cfg.MOSI = pika_hal_open(PIKA_HAL_GPIO, pin);
  180. if (NULL == cfg.MOSI) {
  181. pika_platform_printf("Error: open MOSI '%s' failed.\r\n", pin);
  182. return;
  183. }
  184. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_CONFIG, &cfg);
  185. }
  186. void PikaStdDevice_SPI_setPinSCK(PikaObj* self, char* pin) {
  187. obj_setStr(self, "SCKpin", pin);
  188. pika_dev* dev = _get_dev(self);
  189. if (NULL == dev) {
  190. pika_platform_printf("Error: SPI '%s' not found.\r\n",
  191. obj_getStr(self, "name"));
  192. return;
  193. }
  194. pika_hal_SPI_config cfg = {0};
  195. cfg.SCK = pika_hal_open(PIKA_HAL_GPIO, pin);
  196. if (NULL == cfg.SCK) {
  197. pika_platform_printf("Error: open SCK '%s' failed.\r\n", pin);
  198. return;
  199. }
  200. pika_hal_ioctl(dev, PIKA_HAL_IOCTL_CONFIG, &cfg);
  201. }
  202. void PikaStdDevice_SPI_setPolarity(PikaObj* self, int polarity) {
  203. obj_setInt(self, "polarity", polarity);
  204. }