pad.c 504 B

1234567891011121314151617181920212223242526
  1. #include "data.h";
  2. #include "pad.h";
  3. #include "debug.h";
  4. void enablePad(void)
  5. {
  6. // Enable pad reading and NMI
  7. *(byte *) 0x4200 = 0x01;
  8. }
  9. void disablePad(void)
  10. {
  11. // Enable pad reading and NMI
  12. *(byte *) 0x4200 = 0x00;
  13. }
  14. padStatus readPad(byte padNumber)
  15. {
  16. word test;
  17. padStatus *status;
  18. padNumber = padNumber << 1;
  19. test = (word) * (byte *) 0x4218 + padNumber << 8;
  20. test |= (word) * (byte *) 0x4219 + padNumber;
  21. status = (padStatus *) & test;
  22. return *status;
  23. }