开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > DVD > 查看源码
polling_PS2.c
资源名称：8202s_8281s_050405_dvd_622.rar　[点击查看]
上传用户：caisangzi8
上传日期：2013-10-25
资源大小：15756k
文件大小：9k
源码类别：

DVD

开发平台：

C/C++

polling_PS2.c：源码内容
  1. // polling PS/2 interface
  2. //created by JSLin  //20041022
  3. //well, basically, this file will be included when you defined SUPPORT_PS2 in cfg_xxxxxx.h
  5. //#ifdef  POLLING_DBG
  6. #define MONE_PS2_MOUSE
  7. //#endif
  9. #define X_Pos_Max  340
  10. #define Y_Pos_Max  230
  12. #ifndef SUPPORT_GAMEPAD_MOUSE
  13. #define SendInitCMD_M_0 0
  14. #define SendInitCMD_M_1 1
  15. #define InitCMD_M_End 2
  16. #define SendInitCMD_M_Fail 3
  18. #define Response_M_OK 1
  19. #define Response_M_Faile 0
  21. #define Enable_M_Read 1
  22. #define Disable_M_Read 0
  24. // PS/2 mouse command
  25. #define RESET_M 0xff
  26. #define WorkMod_M 0xEA //StreamMode 0xEA; RemoteMode 0xF0; WrapMode 0xEC
  27. #define Read_Dev_type 0xF2 //read mouse type, receiver 0xFA; standard mouse 0x00; other mouse ....
  28. #define SetSampl_M 0xF3 //set sample rate
  29. #define SamplRat_M 0x28 //10/sec 0x0A; 20/sec 0x14;40/sec 0x28;60/sec 0x3c;80/sec 0x50;100/sec 0x64;200/sec 0xC8
  30. #define Enable_M 0xF4 //enable mouse working
  31. #define MouseInitEnd 0x00
  32. #endif
  34. #ifdef SUPPORT_GAMEPAD_MOUSE
  35. extern int ReadGamePad(void);
  36. #else
  37. void checkMouseEvent(void);
  38. void resetMouse(void);
  39. #endif
  41. void polling_mouse(void);
  42. void updateMouseEvent(void);
  45. typedef struct
  46. {
  47.     BYTE    status;
  48.     BYTE    x;
  49.     BYTE    y;
  50. } MOUSE_EVENT;
  52. MOUSE_EVENT m;
  54. #ifdef SUPPORT_GAMEPAD_MOUSE
  55. BYTE GAMEPAD_DATA0;
  56. BYTE GAMEPAD0_dir;
  57. BYTE GAMEPAD0_btn;
  58. #else
  59. int iMouseState = SendInitCMD_M_0;
  60. BYTE *pMouseResponsebuf, *pMouseRecvPoint;
  61. BYTE  bRtsPoint = 0;
  62. BYTE bHostSendCmdCount = 0;
  63. BYTE bPS2_read_flag = Enable_M_Read;
  65. const BYTE bMouseInitCmd[] = {/*RESET_M,*/ WorkMod_M, SetSampl_M, SamplRat_M, Enable_M, MouseInitEnd};
  66. #endif
  70. #ifdef SUPPORT_GAMEPAD_MOUSE
  71. void polling_mouse(void)
  72. {
  73.     if(ReadGamePad()>0)
  74.     {
  75.         GAMEPAD_DATA0 = regs0->iop_data[4]&0xff;
  76.         GAMEPAD0_dir = GAMEPAD_DATA0&0xf;
  77.         GAMEPAD0_btn = GAMEPAD_DATA0>>4;
  78.         #ifdef MONE_PS2_MOUSE
  79.             //printf("iop_data[4]_L : dir[%x]   btn[%x]n", GAMEPAD0_dir, GAMEPAD0_btn);
  80.         #endif
  81.         updateMouseEvent();
  82.     }
  83. return;
  84. }
  86. void updateMouseEvent(void)
  87. {
  90. //mouse position
  91.     if((~GAMEPAD0_dir)&0x8)
  92.     {
  93.         mouse_pos_y -=1;
  94.     }
  96.     if((~GAMEPAD0_dir)&0x4)
  97.     {
  98.         mouse_pos_y +=1;
  99.     }
  101.     if((~GAMEPAD0_dir)&0x2)
  102.     {
  103.         mouse_pos_x -=1;
  104.     }
  106.     if((~GAMEPAD0_dir)&0x1)
  107.     {
  108.         mouse_pos_x +=1;
  109.     }
  111.     if(mouse_pos_x > X_Pos_Max) 
  112.         {mouse_pos_x = X_Pos_Max;}
  113.     if(mouse_pos_x < 0) 
  114.         {mouse_pos_x = 0;}
  116.     if(mouse_pos_y > Y_Pos_Max) 
  117.         {mouse_pos_y = Y_Pos_Max;}
  118.     if(mouse_pos_y < 0) 
  119.         {mouse_pos_y = 0;}
  122. //mouse button
  123.     if((~GAMEPAD0_btn)&0x8)
  124.     {
  125.         mouse_btn_status |=0x1;
  126.     }
  128.     if((~GAMEPAD0_btn)&0x4)
  129.     {
  130.         mouse_btn_status |=0x2;
  131.     }
  133.     if(GAMEPAD0_btn==0xf)
  134.     {
  135.         mouse_btn_status = 0x0;
  136.     }
  139. }
  141. #else
  142. void polling_mouse(void)
  143. {
  144.     BYTE bNextSend;
  145.     static BYTE bMouse_send_fail;
  147.     
  148.     pMouseResponsebuf = (BYTE *) (SDRAM_BASE_UNCACHED + (regs0->iopya*1024) + 0x302);
  149.     pMouseRecvPoint = (BYTE *) (SDRAM_BASE_UNCACHED + (regs0->iopya*1024) + 0x300);
  152.     switch(iMouseState)
  153.     {
  154.         case SendInitCMD_M_0:   //send command to mouse controller
  155.             if(bMouseInitCmd[bHostSendCmdCount] == MouseInitEnd)
  156.             {
  157.                 iMouseState = InitCMD_M_End;
  158.                 PS2_INIT_DONE = 0x1;
  159.             }
  160.             else
  161.             {
  162.                 #ifdef MONE_PS2_MOUSE
  163.                     printf("n  PS2: XXX  send MouseCmd=[%x] iop_data5=[%x]n",
  164.                             bMouseInitCmd[bHostSendCmdCount], regs0->iop_data[5]);
  165.                 #endif
  166.                 regs0->iop_data[5]=0x8000|bMouseInitCmd[bHostSendCmdCount]; //iop_data2    
  167.                 iMouseState = SendInitCMD_M_1;
  168.                 #ifdef MONE_PS2_MOUSE
  169.                     printf("n  PS2: send MouseCmd=[%x] iop_data5=[%x]n",
  170.                             bMouseInitCmd[bHostSendCmdCount], regs0->iop_data[5]);
  171.                 #endif
  172.             }
  173.             break;
  175.         case SendInitCMD_M_1:
  176.             delay(100);
  177.             #ifdef MONE_PS2_MOUSE
  178.                 printf("n  PS2: SendInitCMD_M_1 [%x] [%x] [%x] [%x]n", 
  179.                 bRtsPoint, *pMouseRecvPoint, pMouseResponsebuf[(*pMouseRecvPoint)-1], regs0->iop_data[5]);
  180.             #endif
  181.             
  182.             if((bRtsPoint == *pMouseRecvPoint) || (pMouseResponsebuf[0]!=0xFA))
  183.             {
  184.                 bMouse_send_fail++;
  185.                 if(bMouse_send_fail ==30)
  186.                 {
  187.                     iMouseState = SendInitCMD_M_0;
  188.                     bMouse_send_fail=0;
  189.                     iMouseState = SendInitCMD_M_Fail;
  190.                     regs0->iop_data[5] = 0x00;
  191.                     #ifdef MONE_PS2_MOUSE
  192.                         //printf("Mouse didn't connectn");
  193.                     #endif
  194.                 }
  195.                 break;
  196.             }
  197.             bMouse_send_fail = 0;
  199.             //check response from mouse controller
  200.             bNextSend = Response_M_Faile;
  201.             switch(pMouseResponsebuf[0])
  202.             {
  203.                 case 0xFA:  //ACK
  204.                     bHostSendCmdCount++;
  205.                     bNextSend = Response_M_OK;
  206.                     break;
  207.                     
  208.                 case 0xFE:  //resend
  209.                     bNextSend = Response_M_OK;
  210.                     break;
  212.                 default:
  213.                       break;
  214.             }
  216.             //send next command to mouse controller
  217.             if(bNextSend == Response_M_OK) 
  218.             {
  219.                 *pMouseRecvPoint = 0;
  220.                 pMouseResponsebuf[0] = 0;
  221.                 iMouseState = SendInitCMD_M_0;
  222.             }
  223.             break;
  225.         case InitCMD_M_End:
  226.                 #ifdef MONE_PS2_MOUSE
  227.                    // printf("n  InitCMD_M_End   n");
  228.                 #endif
  229.                 if(*pMouseRecvPoint)
  230.                 {
  231.                     #ifdef MONE_PS2_MOUSE   
  232.                         //printf("pMouseRecvPoint[%x]  address[%x]n", *pMouseRecvPoint, &(*pMouseRecvPoint));
  233.                     #endif                
  234.                     checkMouseEvent();//(*pMouseRecvPoint);
  235.                  }
  236.             break;
  238.         case SendInitCMD_M_Fail:
  239.         default:
  240.             break;
  241.     }
  242. }
  246. void checkMouseEvent(void)//(BYTE RX)
  247. {
  248.     BYTE bRtsTmp = bRtsPoint;
  249.     int ReceiverCount;
  252.     #ifdef MONE_PS2_MOUSE
  253.         //printf("a [%x] [%x]n", bRtsTmp, *pMouseRecvPoint);
  254.     #endif
  256.     while(1)
  257.     {
  258.         BYTE *m1 = (BYTE *)&m;
  259.         for (ReceiverCount=0; ReceiverCount<3; ReceiverCount++)
  260.         {
  261.             if((bRtsTmp == *pMouseRecvPoint) || (bRtsTmp >12)) 
  262.             {
  263.                 *pMouseRecvPoint = 0;
  264.                 break;
  265.             }
  267.             #ifdef MONE_PS2_MOUSE                    
  268.                 //printf("[%x] [%x]t",&(pMouseResponsebuf[bRtsTmp]), pMouseResponsebuf[bRtsTmp]);
  269.             #endif
  271.             *m1 = pMouseResponsebuf[bRtsTmp];
  272.             m1++;
  273.             bRtsTmp++;
  274.             bPS2_read_flag = Enable_M_Read;
  275.             
  276.         }
  277.         if(ReceiverCount == 3)
  278.         {
  279.             if((m.status&0x08) == 0x08) //valid mouse event
  280.             {
  281.                 updateMouseEvent();
  282.             }
  283.         }
  284.         else 
  285.         {        
  286.             break;
  287.         }
  288.     }
  289. }
  293. void updateMouseEvent(void)
  294. {
  295.     //update mouse position and button status
  297.     //X axle
  298.     if((m.status & 0x10) == 0x10)
  299.     {
  300.         if((((m.x)^0xff)|0x01) > 8) 
  301.             { mouse_pos_x -=8;}
  302.         else
  303.         { mouse_pos_x -= (((m.x)^0xff)|0x01);}
  304.     }
  305.     else
  306.     {
  307.         if(m.x > 8) 
  308.             {mouse_pos_x+=8;}
  309.         else
  310.             {mouse_pos_x += m.x;}
  311.     }
  313.     //Y axle
  314.     if((m.status & 0x20) == 0x20)
  315.     {
  316.         if((((m.y)^0xff)|0x01)>8)
  317.             {mouse_pos_y +=8;}
  318.         else
  319.             {mouse_pos_y += (((m.y)^0xff)|0x01);}
  320.     }
  321.     else
  322.     {
  323.         if(m.y>8) 
  324.             {mouse_pos_y -= 8;}
  325.         else
  326.             {mouse_pos_y -= m.y;}
  327.     }
  329.     if(mouse_pos_x > X_Pos_Max) 
  330.         {mouse_pos_x = X_Pos_Max;}
  331.     if(mouse_pos_x < 0) 
  332.         {mouse_pos_x = 0;}
  334.     if(mouse_pos_y > Y_Pos_Max) 
  335.         {mouse_pos_y = Y_Pos_Max;}
  336.     if(mouse_pos_y < 0) 
  337.         {mouse_pos_y = 0;}
  339.     //mouse button
  340.     mouse_btn_status = (m.status & 0x07);
  341.     
  342.     
  343.     #ifdef MONE_PS2_MOUSE
  344.         printf("==>mous  X[%d]   Y[%d]  B[%d] n", mouse_pos_x, mouse_pos_y, mouse_btn_status);
  345.     #endif    
  346. }
  349. void resetMouse(void)
  350. {
  351.     regs0->iop_data[5]=0x8000|RESET_M;
  352. }
  353. #endif