matrix.c 778 B

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465
  1. // 0 DO
  2. // 1 D1
  3. // 2 D2
  4. // 3 D3
  5. // 4 D4
  6. // 5 D5
  7. // 6 D6
  8. // 7 D7
  9. // 8 B0
  10. // 9 B1
  11. // 10 B2
  12. // 11 B3
  13. // 12 B4
  14. // 13 B5
  15. // 14 C0
  16. // 15 C1
  17. // 16 C2
  18. // 17 C3
  19. // 18 C4
  20. // 19 C5
  21. // UP D3
  22. // LF D6
  23. // DN D7
  24. // RH B0
  25. // A B1 Y
  26. // B B2 X
  27. // C B3 A
  28. // D B4 B
  29. // MN C0
  30. // SH C1
  31. // SL C2
  32. // ST B5
  33. // L1 C3
  34. // L2 C4
  35. // L3 C5
  36. // L4 C6
  37. // L5 D7
  38. matrix[0] = (
  39. (readPin(D3) << 0) |
  40. (readPin(D6) << 1) |
  41. (readPin(D7) << 2) |
  42. (readPin(B0) << 3) |
  43. (readPin(B1) << 4) |
  44. (readPin(B2) << 5) |
  45. (readPin(B3) << 6) |
  46. (readPin(B4) << 7)
  47. );
  48. matrix[1] = (
  49. (readPin(C0) << 0) |
  50. (readPin(C1) << 1) |
  51. (readPin(C2) << 2) |
  52. (readPin(B5) << 3)
  53. );
  54. matrix[2] = (
  55. (readPin(C3) << 0) |
  56. (readPin(C4) << 1) |
  57. (readPin(C5) << 2) |
  58. (readPin(C6) << 3) |
  59. (readPin(D7) << 4)
  60. );