Wireless JoyStick（程序）

highplay86

1. line="1"]/***********************************************************************************************************************************************************
   
2. 头文件包�?***********************************************************************************************************************************************************/
   
3. 
   
4. /***********************************************************************************************************************************************************
   
5. 宏定�?***********************************************************************************************************************************************************/
   
6. #define joystick1_up_down 0
   
7. #define joystick1_left_right 1
   
8. #define joystick1_key 6
   
9. #define wheel_left 4
   
10. 
    
11. #define joystick2_up_down 2
    
12. #define joystick2_left_right 3
    
13. #define joystick2_key 7
    
14. #define wheel_right 5
    
15. 
    
16. /***********************************************************************************************************************************************************
    
17. 变量定义
    
18. ***********************************************************************************************************************************************************/
    
19. struct packet
    
20. {
    
21.     int _joystick1_up_down;
    
22.     int _joystick1_left_right;
    
23.     int _left_wheel;
    
24.     int _joystick2_up_down;
    
25.     int _joystick2_left_right;
    
26.     int _right_wheel;
    
27.     unsigned int _key_status;
    
28. }_packet;
    
29. 
    
30. int joystick_balance_value[6]={0};//存储摇杆平衡位置�?
    
31. /***********************************************************************************************************************************************************
    
32. 获得摇杆平衡位置�?***********************************************************************************************************************************************************/
    
33. void Get_Joystick_Balance_Value(void)
    
34. {
    
35.     unsigned char i;
    
36.    
    
37.     for(i=0;i<20;i++)
    
38.         joystick_balance_value[0]+=analogRead(joystick1_up_down);
    
39.     joystick_balance_value[0]/=20;
    
40.    
    
41.     for(i=0;i<20;i++)
    
42.         joystick_balance_value[1]+=analogRead(joystick1_left_right);
    
43.     joystick_balance_value[1]/=20;
    
44.    
    
45.     for(i=0;i<20;i++)
    
46.         joystick_balance_value[2]+=analogRead(joystick2_up_down);
    
47.     joystick_balance_value[2]/=20;
    
48.    
    
49.     for(i=0;i<20;i++)
    
50.         joystick_balance_value[3]+=analogRead(joystick2_left_right);
    
51.     joystick_balance_value[3]/=20;
    
52.    
    
53.     for(i=0;i<20;i++)
    
54.         joystick_balance_value[4]+=analogRead(wheel_left);
    
55.     joystick_balance_value[4]/=20;
    
56.    
    
57.     for(i=0;i<20;i++)
    
58.         joystick_balance_value[5]+=analogRead(wheel_right);
    
59.     joystick_balance_value[5]/=20;
    
60. }
    
61. 
    
62. /***********************************************************************************************************************************************************
    
63. 获得摇杆当前&#65533;?***********************************************************************************************************************************************************/
    
64. void Get_Joystick_Present_Value(void)
    
65. {
    
66.     unsigned char KEY_temp;
    
67.     int temp;
    
68.     temp=(analogRead(joystick1_up_down)-joystick_balance_value[0])/20*20;
    
69.     _packet._joystick1_up_down=*((unsigned int *)&temp);
    
70.    
    
71.     temp=(analogRead(joystick1_left_right)-joystick_balance_value[1])/20*20;
    
72.     _packet._joystick1_left_right=*((unsigned int *)&temp);
    
73.    
    
74.     temp=(analogRead(joystick2_up_down)-joystick_balance_value[2])/20*20;
    
75.     _packet._joystick2_up_down=*((unsigned int *)&temp);
    
76.    
    
77.     temp=(analogRead(joystick2_left_right)-joystick_balance_value[3])/20*20;
    
78.     _packet._joystick2_left_right=*((unsigned int *)&temp);
    
79.    
    
80.     temp=(joystick_balance_value[4]-analogRead(wheel_left))/20*20;
    
81.     _packet._left_wheel=*((unsigned int *)&temp);
    
82.    
    
83.     temp=(joystick_balance_value[5]-analogRead(wheel_right))/20*20;
    
84.     _packet._right_wheel=*((unsigned int *)&temp);
    
85.    
    
86.     _packet._key_status=0;
    
87.     if(analogRead(joystick1_key)>(0x03ff-500))
    
88.         _packet._key_status+=1<<13;
    
89.     if(analogRead(joystick2_key)>(0x03ff-0x02ff))//有问&#65533;?        _packet._key_status+=1<<12;
    
90.      KEY_temp=PIND;
    
91.      KEY_temp>>=2;
    
92.      _packet._key_status+=KEY_temp<<6;
    
93.      
    
94.      KEY_temp=PINB;
    
95.      KEY_temp&=0x3f;
    
96.      _packet._key_status+=KEY_temp;
    
97. }
    
98. 
    
99. void setup()
    
100. {
     
101.     Serial.begin(57600);     
     
102.     DDRB&=0xc0;
     
103.     DDRD&=0x03;
     
104. }
     
105. 
     
106. void loop()
     
107. {
     
108.     unsigned char i;
     
109.     unsigned int ADC_temp;
     
110.     unsigned char KEY_temp;
     
111.     unsigned char XOR_check=0;
     
112.     delay(100);
     
113.     Get_Joystick_Balance_Value();
     
114.    
     
115.     while(1)
     
116.     {
     
117.         XOR_check=0x55^0xaa;
     
118.         Get_Joystick_Present_Value();
     
119.         for(i=0;i<14;i++)
     
120.         {
     
121.             //XOR_check^=*((unsigned char *)&_packet+i+1);
     
122.             XOR_check^=*((unsigned char *)&_packet+i);
     
123.         }
     
124.         Serial.print(0x55,BYTE);
     
125.         Serial.print(0xaa,BYTE);
     
126.         for(i=0;i<14;i++)
     
127.         {
     
128.             //Serial.print( *((unsigned char *)&_packet+i+1),BYTE);
     
129.             Serial.print( *((unsigned char *)&_packet+i),BYTE);
     
130.         }
     
131.         Serial.print(XOR_check,BYTE);
     
132.         delay(200);
     
133.     }
     
134. }

复制代码

[/code][/code]










有哥们用过这货吗?...