|
1 | 1 | #include "fcntl.h" |
2 | 2 |
|
3 | | -char get_SW0(void){ |
4 | | - char buf[2]; |
5 | | - int SW0; |
6 | | - SW0 = open("/dev/rtswitch0",O_RDONLY); |
7 | | - read(SW0,buf,2); |
8 | | - close(SW0); |
9 | | - return buf[0]; |
| 3 | +char get_SW0(void) { |
| 4 | + char buf[2]; |
| 5 | + int SW0; |
| 6 | + SW0 = open("/dev/rtswitch0", O_RDONLY); |
| 7 | + read(SW0, buf, 2); |
| 8 | + close(SW0); |
| 9 | + return buf[0]; |
10 | 10 | } |
11 | 11 |
|
12 | | -char get_SW1(void){ |
13 | | - char buf[2]; |
14 | | - int SW1; |
15 | | - SW1 = open("/dev/rtswitch1",O_RDONLY); |
16 | | - read(SW1,buf,2); |
17 | | - close(SW1); |
18 | | - return buf[0]; |
| 12 | +char get_SW1(void) { |
| 13 | + char buf[2]; |
| 14 | + int SW1; |
| 15 | + SW1 = open("/dev/rtswitch1", O_RDONLY); |
| 16 | + read(SW1, buf, 2); |
| 17 | + close(SW1); |
| 18 | + return buf[0]; |
19 | 19 | } |
20 | 20 |
|
21 | | -char get_SW2(void){ |
22 | | - char buf[2]; |
23 | | - int SW2; |
24 | | - SW2 = open("/dev/rtswitch2",O_RDONLY); |
25 | | - read(SW2,buf,2); |
26 | | - close(SW2); |
27 | | - return buf[0]; |
| 21 | +char get_SW2(void) { |
| 22 | + char buf[2]; |
| 23 | + int SW2; |
| 24 | + SW2 = open("/dev/rtswitch2", O_RDONLY); |
| 25 | + read(SW2, buf, 2); |
| 26 | + close(SW2); |
| 27 | + return buf[0]; |
28 | 28 | } |
29 | 29 |
|
| 30 | +void main(void) { |
| 31 | + int state0, state1, state2; |
| 32 | + int LED0, LED1, LED2, LED3; |
30 | 33 |
|
| 34 | + LED0 = open("/dev/rtled0", O_WRONLY); |
| 35 | + LED1 = open("/dev/rtled1", O_WRONLY); |
| 36 | + LED2 = open("/dev/rtled2", O_WRONLY); |
| 37 | + LED3 = open("/dev/rtled3", O_WRONLY); |
31 | 38 |
|
32 | | -void main(void){ |
33 | | - int state0,state1,state2; |
34 | | - int LED0,LED1,LED2,LED3; |
| 39 | + state0 = state1 = state2 = 0; |
35 | 40 |
|
36 | | - LED0 = open("/dev/rtled0",O_WRONLY); |
37 | | - LED1 = open("/dev/rtled1",O_WRONLY); |
38 | | - LED2 = open("/dev/rtled2",O_WRONLY); |
39 | | - LED3 = open("/dev/rtled3",O_WRONLY); |
40 | | - |
41 | | - state0 = state1 = state2 = 0; |
42 | | - |
43 | | - while(1){ |
44 | | - if (get_SW0() =='0'){ |
45 | | - usleep(10000); |
46 | | - while (get_SW0() == '0'); |
47 | | - usleep(10000); |
48 | | - state0=(state0+1)&0x01; |
49 | | - if(state0==0){ |
50 | | - write(LED3,"0",1); |
51 | | - }else{ |
52 | | - write(LED3,"1",1); |
53 | | - } |
54 | | - } |
55 | | - if (get_SW1() =='0'){ |
56 | | - usleep(10000); |
57 | | - while (get_SW1() == '0'); |
58 | | - usleep(10000); |
59 | | - state1=(state1+1)&0x01; |
60 | | - if(state1==0){ |
61 | | - write(LED2,"0",1); |
62 | | - write(LED1,"0",1); |
63 | | - }else{ |
64 | | - write(LED2,"1",1); |
65 | | - write(LED1,"1",1); |
66 | | - } |
67 | | - } |
68 | | - if (get_SW2() =='0'){ |
69 | | - usleep(10000); |
70 | | - while (get_SW2() == '0'); |
71 | | - usleep(10000); |
72 | | - state2=(state2+1)&0x01; |
73 | | - if(state2==0){ |
74 | | - write(LED0,"0",1); |
75 | | - }else{ |
76 | | - write(LED0,"1",1); |
77 | | - } |
78 | | - } |
79 | | - } |
| 41 | + while (1) { |
| 42 | + if (get_SW0() == '0') { |
| 43 | + usleep(10000); |
| 44 | + while (get_SW0() == '0') |
| 45 | + ; |
| 46 | + usleep(10000); |
| 47 | + state0 = (state0 + 1) & 0x01; |
| 48 | + if (state0 == 0) { |
| 49 | + write(LED3, "0", 1); |
| 50 | + } else { |
| 51 | + write(LED3, "1", 1); |
| 52 | + } |
| 53 | + } |
| 54 | + if (get_SW1() == '0') { |
| 55 | + usleep(10000); |
| 56 | + while (get_SW1() == '0') |
| 57 | + ; |
| 58 | + usleep(10000); |
| 59 | + state1 = (state1 + 1) & 0x01; |
| 60 | + if (state1 == 0) { |
| 61 | + write(LED2, "0", 1); |
| 62 | + write(LED1, "0", 1); |
| 63 | + } else { |
| 64 | + write(LED2, "1", 1); |
| 65 | + write(LED1, "1", 1); |
| 66 | + } |
| 67 | + } |
| 68 | + if (get_SW2() == '0') { |
| 69 | + usleep(10000); |
| 70 | + while (get_SW2() == '0') |
| 71 | + ; |
| 72 | + usleep(10000); |
| 73 | + state2 = (state2 + 1) & 0x01; |
| 74 | + if (state2 == 0) { |
| 75 | + write(LED0, "0", 1); |
| 76 | + } else { |
| 77 | + write(LED0, "1", 1); |
| 78 | + } |
| 79 | + } |
| 80 | + } |
80 | 81 | } |
81 | | - |
82 | | - |
83 | | - |
0 commit comments