root / lab4 / lab4.c @ 78
History | View | Annotate | Download (8.26 KB)
1 | 53 | up20180655 | #include <lcom/lcf.h> |
---|---|---|---|
2 | |||
3 | #include <stdint.h> |
||
4 | #include <stdio.h> |
||
5 | |||
6 | 58 | up20180642 | #include "mouse.h" |
7 | #include "kbc.h" |
||
8 | 70 | up20180655 | #include "errors.h" |
9 | #include "mouse_macros.h" |
||
10 | 78 | up20180655 | #include "kbc_macros.h" |
11 | 74 | up20180642 | #include "timer.h" |
12 | 78 | up20180655 | #include "state_machine.h" |
13 | 53 | up20180655 | |
14 | int main(int argc, char *argv[]) { |
||
15 | // sets the language of LCF messages (can be either EN-US or PT-PT)
|
||
16 | lcf_set_language("EN-US");
|
||
17 | |||
18 | // enables to log function invocations that are being "wrapped" by LCF
|
||
19 | // [comment this out if you don't want/need/ it]
|
||
20 | lcf_trace_calls("/home/lcom/labs/lab4/trace.txt");
|
||
21 | |||
22 | // enables to save the output of printf function calls on a file
|
||
23 | // [comment this out if you don't want/need it]
|
||
24 | lcf_log_output("/home/lcom/labs/lab4/output.txt");
|
||
25 | |||
26 | // handles control over to LCF
|
||
27 | // [LCF handles command line arguments and invokes the right function]
|
||
28 | if (lcf_start(argc, argv))
|
||
29 | return 1; |
||
30 | |||
31 | // LCF clean up tasks
|
||
32 | // [must be the last statement before return]
|
||
33 | lcf_cleanup(); |
||
34 | |||
35 | return 0; |
||
36 | } |
||
37 | |||
38 | 56 | up20180642 | extern uint8_t packet[3]; |
39 | extern int counter; |
||
40 | 53 | up20180655 | |
41 | int (mouse_test_packet)(uint32_t cnt) {
|
||
42 | 77 | up20180642 | int ret = 0; |
43 | 55 | up20180642 | /// loop stuff
|
44 | int ipc_status, r;
|
||
45 | message msg; |
||
46 | 74 | up20180642 | /// Mouse interrupt handling
|
47 | 55 | up20180642 | uint8_t mouse_irq_bit = 12;
|
48 | int mouse_id = 0; |
||
49 | int mouse_irq = BIT(mouse_irq_bit);
|
||
50 | 77 | up20180642 | if ((ret = mouse_set_data_report(true))) return ret; |
51 | //if ((ret = mouse_enable_data_reporting())) return ret;
|
||
52 | 76 | up20180655 | |
53 | 55 | up20180642 | if (subscribe_mouse_interrupt(mouse_irq_bit, &mouse_id)) return 1; |
54 | /// cycle
|
||
55 | int good = 1; |
||
56 | 56 | up20180642 | uint32_t cnt_now = 0;
|
57 | 55 | up20180642 | while (good) {
|
58 | /* Get a request message. */
|
||
59 | if ((r = driver_receive(ANY, &msg, &ipc_status)) != 0) { |
||
60 | printf("driver_receive failed with %d", r);
|
||
61 | continue;
|
||
62 | } |
||
63 | if (is_ipc_notify(ipc_status)) { /* received notification */ |
||
64 | switch (_ENDPOINT_P(msg.m_source)) {
|
||
65 | case HARDWARE: /* hardware interrupt notification */ |
||
66 | if (msg.m_notify.interrupts & mouse_irq) { /* subscribed interrupt */ |
||
67 | mouse_ih(); |
||
68 | 56 | up20180642 | if(counter >= 3){ |
69 | struct packet pp = mouse_parse_packet(packet);
|
||
70 | mouse_print_packet(&pp); |
||
71 | cnt_now++; |
||
72 | if(cnt == cnt_now) good = 0; |
||
73 | } |
||
74 | 55 | up20180642 | } |
75 | break;
|
||
76 | default:
|
||
77 | break; /* no other notifications expected: do nothing */ |
||
78 | } |
||
79 | } else { /* received standart message, not a notification */ |
||
80 | /* no standart message expected: do nothing */
|
||
81 | } |
||
82 | } |
||
83 | if (unsubscribe_interrupt(&mouse_id)) return 1; |
||
84 | 73 | up20180642 | if (mouse_set_data_report(false)) return 1; |
85 | 55 | up20180642 | return 0; |
86 | 53 | up20180655 | } |
87 | |||
88 | int (mouse_test_remote)(uint16_t period, uint8_t cnt) {
|
||
89 | 70 | up20180655 | |
90 | // Mouse packets data
|
||
91 | uint8_t packet[3];
|
||
92 | int sz = 0; |
||
93 | uint8_t data = 0;
|
||
94 | // Cycle
|
||
95 | int packetCounter = 0; |
||
96 | int good = 1; |
||
97 | // return value
|
||
98 | int ret;
|
||
99 | |||
100 | 78 | up20180655 | if ((ret = mouse_issue_cmd(SET_REMOTE_MD))) return ret; |
101 | |||
102 | if ((ret = mouse_set_data_report(true))) return ret; |
||
103 | |||
104 | uint8_t cmd = 0;
|
||
105 | if ((ret = kbc_read_cmd(&cmd))) return ret; |
||
106 | |||
107 | 70 | up20180655 | while (good) {
|
108 | |||
109 | if ((ret = mouse_read_data(&data))) return ret; |
||
110 | |||
111 | if ((data & FIRST_BYTE_ID) || sz) {
|
||
112 | packet[sz] = data; |
||
113 | sz++; |
||
114 | } |
||
115 | if (sz == 3) { |
||
116 | struct packet pp = mouse_parse_packet(packet);
|
||
117 | mouse_print_packet(&pp); |
||
118 | packetCounter++; |
||
119 | sz = 0;
|
||
120 | if (packetCounter == cnt) good = 0; |
||
121 | } |
||
122 | tickdelay(micros_to_ticks(period*1e3));
|
||
123 | } |
||
124 | |||
125 | // Set Stream mode
|
||
126 | if ((ret = mouse_issue_cmd(SET_STREAM_MD))) return ret; |
||
127 | // Disable data reporting
|
||
128 | 73 | up20180642 | if ((ret = mouse_set_data_report(false))) return ret; |
129 | 70 | up20180655 | uint8_t cmd_byte = minix_get_dflt_kbc_cmd_byte(); |
130 | if ((ret = kbc_change_cmd(cmd_byte))) return ret; |
||
131 | |||
132 | return SUCCESS;
|
||
133 | 53 | up20180655 | } |
134 | |||
135 | int (mouse_test_async)(uint8_t idle_time) {
|
||
136 | 74 | up20180642 | /// loop stuff
|
137 | int ipc_status, r;
|
||
138 | message msg; |
||
139 | /// Timer interrupt handling
|
||
140 | const uint32_t frequency = sys_hz(); // Frequency asummed at 60Hz |
||
141 | uint8_t timer_irq_bit = 0;
|
||
142 | int timer_id = 0; |
||
143 | int timer_irq = BIT(timer_irq_bit);
|
||
144 | if(subscribe_timer_interrupt(timer_irq_bit, &timer_id)) return 1; |
||
145 | |||
146 | no_interrupts = 0;
|
||
147 | int time = 0; |
||
148 | /// Mouse interrupt handling
|
||
149 | uint8_t mouse_irq_bit = 12;
|
||
150 | int mouse_id = 0; |
||
151 | int mouse_irq = BIT(mouse_irq_bit);
|
||
152 | 76 | up20180655 | if (mouse_set_data_report(true)) return 1; |
153 | |||
154 | 74 | up20180642 | if (subscribe_mouse_interrupt(mouse_irq_bit, &mouse_id)) return 1; |
155 | /// cycle
|
||
156 | int good = 1; |
||
157 | while (good) {
|
||
158 | /* Get a request message. */
|
||
159 | if ((r = driver_receive(ANY, &msg, &ipc_status)) != 0) { |
||
160 | printf("driver_receive failed with %d", r);
|
||
161 | continue;
|
||
162 | } |
||
163 | if (is_ipc_notify(ipc_status)) { /* received notification */ |
||
164 | switch (_ENDPOINT_P(msg.m_source)) {
|
||
165 | case HARDWARE: /* hardware interrupt notification */ |
||
166 | if (msg.m_notify.interrupts & timer_irq) { /* subscribed interrupt */ |
||
167 | timer_int_handler(); |
||
168 | if (no_interrupts%frequency == 0) time++; |
||
169 | if(time >= idle_time) good = 0; |
||
170 | } |
||
171 | if (msg.m_notify.interrupts & mouse_irq) { /// subscribed interrupt |
||
172 | mouse_ih(); |
||
173 | if(counter >= 3){ |
||
174 | struct packet pp = mouse_parse_packet(packet);
|
||
175 | mouse_print_packet(&pp); |
||
176 | time = 0;
|
||
177 | no_interrupts = 0;
|
||
178 | } |
||
179 | } |
||
180 | break;
|
||
181 | default:
|
||
182 | break; /* no other notifications expected: do nothing */ |
||
183 | } |
||
184 | } else { /* received standart message, not a notification */ |
||
185 | /* no standart message expected: do nothing */
|
||
186 | } |
||
187 | } |
||
188 | |||
189 | if (unsubscribe_interrupt(&mouse_id)) return 1; |
||
190 | if (mouse_set_data_report(false)) return 1; |
||
191 | |||
192 | if (unsubscribe_interrupt(&timer_id)) return 1; |
||
193 | |||
194 | return 0; |
||
195 | 53 | up20180655 | } |
196 | |||
197 | 54 | up20180642 | int (mouse_test_gesture)(uint8_t x_len, uint8_t tolerance) {
|
198 | 77 | up20180642 | /// loop stuff
|
199 | int ipc_status, r;
|
||
200 | message msg; |
||
201 | /// Mouse interrupt handling
|
||
202 | uint8_t mouse_irq_bit = 12;
|
||
203 | int mouse_id = 0; |
||
204 | int mouse_irq = BIT(mouse_irq_bit);
|
||
205 | //if ((ret = mouse_set_data_report(true))) return ret;
|
||
206 | 78 | up20180655 | if (mouse_enable_data_reporting()) return 1; |
207 | 77 | up20180642 | |
208 | if (subscribe_mouse_interrupt(mouse_irq_bit, &mouse_id)) return 1; |
||
209 | /// cycle
|
||
210 | int good = 1; |
||
211 | 78 | up20180655 | |
212 | // mouse event gesture
|
||
213 | struct mouse_ev *event;
|
||
214 | struct packet pp;
|
||
215 | int response;
|
||
216 | |||
217 | 77 | up20180642 | while (good) {
|
218 | /* Get a request message. */
|
||
219 | if ((r = driver_receive(ANY, &msg, &ipc_status)) != 0) { |
||
220 | printf("driver_receive failed with %d", r);
|
||
221 | continue;
|
||
222 | } |
||
223 | if (is_ipc_notify(ipc_status)) { /* received notification */ |
||
224 | switch (_ENDPOINT_P(msg.m_source)) {
|
||
225 | case HARDWARE: /* hardware interrupt notification */ |
||
226 | if (msg.m_notify.interrupts & mouse_irq) { /* subscribed interrupt */ |
||
227 | mouse_ih(); |
||
228 | 78 | up20180655 | if(counter >= 3) { |
229 | pp = mouse_parse_packet(packet); |
||
230 | //mouse_print_packet(&pp);
|
||
231 | event = mouse_get_event(&pp); |
||
232 | |||
233 | response = state_machine(event, x_len, tolerance); |
||
234 | |||
235 | if (response == SUCCESS)
|
||
236 | good = 0;
|
||
237 | else if (response == INVALID_STATE) |
||
238 | return response;
|
||
239 | 77 | up20180642 | } |
240 | } |
||
241 | break;
|
||
242 | default:
|
||
243 | break; /* no other notifications expected: do nothing */ |
||
244 | } |
||
245 | } else { /* received standart message, not a notification */ |
||
246 | /* no standart message expected: do nothing */
|
||
247 | } |
||
248 | } |
||
249 | if (unsubscribe_interrupt(&mouse_id)) return 1; |
||
250 | if (mouse_set_data_report(false)) return 1; |
||
251 | |||
252 | return 0; |
||
253 | 53 | up20180655 | } |