Category

Development Platform
Home > SourceCode/Document > OS Develop > View Code
ps2base.c
Package: tizos.rar　[view]
Upload User: qddsws
Upload Date: 2022-06-22
Package Size: 723k
Code Size: 1k
Category:

OS Develop

Development Platform:

C/C++

ps2base.c：Code Content
  1. #include <devices/ps2base.h>
  2. void kbdWrite(word port, byte data) {
  3. dword timeout;
  4. byte stat;
  5. for (timeout = 500000L; timeout != 0; timeout--){
  6. stat = inportb(KEYB_CTRL);
  7. if ((stat & 0x02) == 0) break;
  8. }
  9. if (timeout != 0) outportb(port, data);
  10. }
  12. byte kbdRead() {
  13. unsigned long Timeout;
  14. byte Stat, Data;
  15. for (Timeout = 50000L; Timeout != 0; Timeout--) {
  16. Stat = inportb(KEYB_CTRL);
  17. /* loop until 8042 output buffer full */
  18. if ((Stat & 0x01) != 0) {
  19. Data = inportb(KEYB_PORT);
  20. /* loop if parity error or receive timeout */
  21. if((Stat & 0xC0) == 0) return Data;
  23. }
  24. }
  25. return -1;
  26. }
  28. byte kbdWriteRead(word port, byte data, const char* expect) {
  29. int RetVal;
  30. kbdWrite(port, data);
  31. for (; *expect; expect++) {
  32. RetVal = kbdRead();
  33. if ((byte) *expect != RetVal) {
  34.   return RetVal;
  35. }
  36. }
  37. return 0;
  39. }