main.cpp 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406
  1. #include "mbed.h"
  2. #include "SWO.h"
  3. #include "pca9685.h"
  4. #include "tusb322.h"
  5. #include "ds3231.h"
  6. DigitalIn nFault(PA_3);
  7. DigitalIn Usb(PB_4);
  8. DigitalOut HvEn(PA_2);
  9. DigitalOut nNixieEn(PA_7);
  10. DigitalOut AmpEn(PB_1);
  11. DigitalOut LED(PB_6);
  12. AnalogIn Imon(PA_0);
  13. AnalogIn Vout(PA_1);
  14. AnalogOut Aout(PA_5);
  15. I2C i2c(PA_10, PA_9);
  16. SWO_Channel swo("swo");
  17. PCM9685_REGS Regs[3] = {0};
  18. // Calculate the byte offset of a field in a structure of type type.
  19. #define FIELD_OFFSET(type, field) ((uint32_t)(uint32_t*)&(((type *)0)->field))
  20. void Clock_Update(int tube, int digit, int brightness) {
  21. char buffer[sizeof(LED_CTRL)+1] = {0};
  22. if (!nFault.read()) { LED.write(1); while(1); }
  23. buffer[0] = FIELD_OFFSET(PCM9685_REGS, LED0) +
  24. (Tube_Mapping[tube][digit][MAP_PIN] * sizeof(LED_CTRL));
  25. LED_CTRL *reg = (LED_CTRL*)&buffer[1];
  26. if (brightness >= 1000) {
  27. reg->ON_FULL = 1;
  28. } else if (brightness == 0) {
  29. reg->OFF_FULL = 1;
  30. } else {
  31. reg->OFF = brightness * 4;
  32. }
  33. i2c.write(Tube_Mapping[tube][digit][MAP_ADDR] << 1, buffer, sizeof(buffer));
  34. }
  35. void Dot_Update(int brightness) {
  36. char buffer[sizeof(LED_CTRL)+1] = {0};
  37. buffer[0] = FIELD_OFFSET(PCM9685_REGS, TUBE_DOT_PIN);
  38. LED_CTRL *reg = (LED_CTRL*)&buffer[1];
  39. if (brightness == 0) {
  40. reg->OFF_FULL = 1;
  41. } else {
  42. reg->OFF = brightness;
  43. }
  44. i2c.write(TUBE_DOT_ADDR << 1, buffer, sizeof(buffer));
  45. }
  46. void Clock_Init() {
  47. char buffer[sizeof(REG_MODE1)+sizeof(REG_MODE2)+1] = {0};
  48. buffer[0] = FIELD_OFFSET(PCM9685_REGS, MODE1);
  49. REG_MODE1 *reg1 = (REG_MODE1*)&buffer[1];
  50. reg1->AI = 1; // Turn on autoincrement
  51. reg1->SLEEP = 1; // Start disabled
  52. reg1->ALLCALL = 1; // Enable response to all call address
  53. REG_MODE2 *reg2 = (REG_MODE2*)&buffer[1+sizeof(REG_MODE1)];
  54. reg2->OUTDRV = 1; // Configure output for totem pole drive
  55. i2c.write(PCM9685_All_Call << 1, buffer, sizeof(buffer));
  56. char pre_scale[2] = {0};
  57. pre_scale[0] = FIELD_OFFSET(PCM9685_REGS, PRE_SCALE);
  58. pre_scale[1] = 0x03; // Set PWM frequency to 1526 Hz
  59. i2c.write(PCM9685_All_Call << 1, pre_scale, sizeof(pre_scale));
  60. Dot_Update(0);
  61. for (int i = 0; i < 4; i++) {
  62. for (int j = 0; j < 10; j++) {
  63. Clock_Update(i, j, 0);
  64. }
  65. }
  66. reg1->SLEEP = 0;
  67. i2c.write(PCM9685_All_Call << 1, buffer, sizeof(buffer));
  68. }
  69. void Set_Analog(float voltage) {
  70. voltage = voltage * 0.6;
  71. Aout.write(voltage);
  72. }
  73. void USB_Init() {
  74. char buffer[sizeof(TUSB322_REGS)] = {0};
  75. // Disable UFP accessory support (otherwise IC stays in DRP mode)
  76. buffer[0] = FIELD_OFFSET(TUSB322_REGS, Status2);
  77. CONN_STATUS2 *stat = (CONN_STATUS2*)&buffer[1];
  78. stat->UFP_ACCESSORY = 0x1;
  79. i2c.write(TUSB322_ADDR << 1, buffer, 2);
  80. // Disable CC termination to change to UFP mode
  81. buffer[0] = FIELD_OFFSET(TUSB322_REGS, Control);
  82. CTRL *ctrl = (CTRL*)&buffer[1];
  83. ctrl->DISABLE_TERM = 0x1;
  84. i2c.write(TUSB322_ADDR << 1, buffer, 2);
  85. // For operation in UFP mode
  86. ctrl->MODE_SELECT = 0x01;
  87. i2c.write(TUSB322_ADDR << 1, buffer, 2);
  88. // Reenable CC termination
  89. ctrl->DISABLE_TERM = 0x0;
  90. i2c.write(TUSB322_ADDR << 1, buffer, 2);
  91. }
  92. //#define CURRENT_TEST
  93. #define CYCLE_DISPLAY
  94. #define CYCLE_BASIC
  95. //#define CYCLE_ANALOG
  96. #define CYCLE_PWM
  97. #define CYCLE_FADE
  98. #define CYCLE_FADE_RANDOM
  99. #define CYCLE_FAST
  100. #define CYCLE_FAST_RANDOM
  101. int main() {
  102. // Initialize pins
  103. i2c.frequency(1000000);
  104. // Power up PCA9685 at 3.3V with outputs disabled
  105. Aout.write(1);
  106. AmpEn.write(1);
  107. nNixieEn.write(1);
  108. // Start with HV PSU disabled
  109. HvEn.write(0);
  110. USB_Init();
  111. LED.write(1);
  112. wait(1);
  113. LED.write(0);
  114. Clock_Init();
  115. nNixieEn.write(0);
  116. // Enable HV PSU
  117. HvEn.write(1);
  118. // Reduce PCA9685 voltage
  119. Set_Analog(1);
  120. swo.printf("CPU SystemCoreClock is %d Hz\r\n", SystemCoreClock);
  121. #ifdef CURRENT_TEST
  122. Dot_Update(100);
  123. Clock_Update(3, 1, 100);
  124. Clock_Update(2, 3, 100);
  125. Clock_Update(1, 5, 100);
  126. Clock_Update(0, 7, 100);
  127. #endif
  128. while(1) {
  129. int i_curr[4];
  130. int i_next[4];
  131. #ifdef CYCLE_DISPLAY
  132. Set_Analog(1);
  133. #ifdef CYCLE_BASIC
  134. // Switch each digit from 0 to 100%
  135. for (int i = 0; i < 10; i++) {
  136. if (i % 2 == 0) {
  137. Dot_Update(0);
  138. } else {
  139. Dot_Update(1000);
  140. }
  141. for (int j = 0; j < 4; j++) {
  142. Clock_Update(j, i, 1000);
  143. }
  144. wait(0.5);
  145. for (int j = 0; j < 4; j++) {
  146. Clock_Update(j, i, 0);
  147. }
  148. }
  149. #endif
  150. #ifdef CYCLE_ANALOG
  151. for (int i = 0; i < 10; i++) {
  152. nNixieEn.write(1);
  153. for (int j = 0; j < 4; j++) {
  154. Clock_Update(j, i, 1000);
  155. Dot_Update(1000);
  156. }
  157. for (double k = 1; k >= 0.1; k -= 0.001) {
  158. Set_Analog(k);
  159. wait(0.0001);
  160. }
  161. nNixieEn.write(0);
  162. for (double k = 0.1; k <= 1; k += 0.001) {
  163. Set_Analog(k);
  164. wait(0.001);
  165. }
  166. wait(0.2);
  167. for (double k = 1; k >= 0.1; k -= 0.001) {
  168. Set_Analog(k);
  169. wait(0.001);
  170. }
  171. nNixieEn.write(1);
  172. for (double k = 0.1; k <= 1; k += 0.001) {
  173. Set_Analog(k);
  174. wait(0.0001);
  175. }
  176. for (int j = 0; j < 4; j++) {
  177. Clock_Update(j, i, 0);
  178. Dot_Update(0);
  179. }
  180. }
  181. nNixieEn.write(0);
  182. Set_Analog(1);
  183. #endif
  184. #ifdef CYCLE_PWM
  185. for (int i = 0; i < 10; i++) {
  186. for (int k = 0; k <= 1000; k++) {
  187. for (int j = 0; j < 4; j++) {
  188. Clock_Update(j, i, k);
  189. Dot_Update(k);
  190. }
  191. wait(0.0001);
  192. }
  193. for (int k = 0; k <= 1000; k++) {
  194. for (int j = 0; j < 4; j++) {
  195. Clock_Update(j, i, 1000-k);
  196. Dot_Update(1000-k);;
  197. }
  198. wait(0.0001);
  199. }
  200. wait(0.2);
  201. }
  202. #endif
  203. #ifdef CYCLE_FADE
  204. Set_Analog(1);
  205. Dot_Update(0);
  206. for (int i = 0; i < 10; i++) {
  207. int i_next = (i == 9) ? 0 : i+1;
  208. for (int k = 0; k <= 1000; k++) {
  209. for (int j = 0; j < 4; j++) {
  210. Clock_Update(j, i, 1000-k);
  211. Clock_Update(j, i_next, k);
  212. }
  213. if (i % 2 == 0) {
  214. Dot_Update(k);
  215. } else {
  216. Dot_Update(1000-k);
  217. }
  218. wait(0.00005);
  219. }
  220. wait(0.2);
  221. }
  222. for (int i = 0; i < 4; i++) {
  223. for (int j = 0; j < 10; j++) {
  224. Clock_Update(i, j, 0);
  225. }
  226. }
  227. #endif
  228. #ifdef CYCLE_FADE_RANDOM
  229. Set_Analog(1);
  230. Dot_Update(0);
  231. for (int i = 0; i < 4; i++) {
  232. i_curr[i] = rand() % 10;
  233. }
  234. for (int k = 0; k <= 1000; k++) {
  235. for (int j = 0; j < 4; j++) {
  236. Clock_Update(j, i_curr[j], k);
  237. }
  238. wait(0.00005);
  239. }
  240. for (int iter = 0; iter < 10; iter++) {
  241. for (int i = 0; i < 4; i++) {
  242. do {
  243. i_next[i] = rand() % 10;
  244. } while (i_next[i] == i_curr[i]);
  245. }
  246. for (int k = 0; k <= 1000; k++) {
  247. for (int j = 0; j < 4; j++) {
  248. Clock_Update(j, i_curr[j], 1000-k);
  249. Clock_Update(j, i_next[j], k);
  250. }
  251. if (iter % 2 == 0) {
  252. Dot_Update(k);
  253. } else {
  254. Dot_Update(1000-k);
  255. }
  256. wait(0.00005);
  257. }
  258. wait(0.2);
  259. for (int i = 0; i < 4; i++) {
  260. i_curr[i] = i_next[i];
  261. }
  262. }
  263. for (int k = 1000; k >= 0; k--) {
  264. for (int j = 0; j < 4; j++) {
  265. Clock_Update(j, i_curr[j], k);
  266. }
  267. wait(0.00005);
  268. }
  269. #endif
  270. #ifdef CYCLE_FAST
  271. Set_Analog(1);
  272. Dot_Update(0);
  273. for (int k = 0; k < 10; k++) {
  274. for (int i = 0; i < 10; i++) {
  275. for (int j = 0; j < 4; j++) {
  276. Clock_Update(j, i, 1000);
  277. }
  278. if (i % 2 == 0) {
  279. Dot_Update(1000);
  280. } else {
  281. Dot_Update(0);
  282. }
  283. wait(0.1);
  284. for (int j = 0; j < 4; j++) {
  285. Clock_Update(j, i, 0);
  286. }
  287. }
  288. }
  289. #endif
  290. #ifdef CYCLE_FAST_RANDOM
  291. Set_Analog(1);
  292. Dot_Update(0);
  293. for (int i = 0; i < 4; i++) {
  294. i_curr[i] = rand() % 10;
  295. }
  296. for (int k = 0; k < 100; k++) {
  297. for (int i = 0; i < 4; i++) {
  298. do {
  299. i_next[i] = rand() % 10;
  300. } while (i_next[i] == i_curr[i]);
  301. }
  302. for (int j = 0; j < 4; j++) {
  303. Clock_Update(j, i_next[j], 1000);
  304. }
  305. if (k % 2 == 0) {
  306. Dot_Update(1000);
  307. } else {
  308. Dot_Update(0);
  309. }
  310. wait(0.1);
  311. for (int j = 0; j < 4; j++) {
  312. Clock_Update(j, i_next[j], 0);
  313. }
  314. for (int i = 0; i < 4; i++) {
  315. i_curr[i] = i_next[i];
  316. }
  317. }
  318. #endif
  319. #endif
  320. }
  321. }