Revision 115
removed uninportant part
lab5.c | ||
---|---|---|
275 | 275 |
} |
276 | 276 |
|
277 | 277 |
int(video_test_move)(xpm_map_t xpm, uint16_t xi, uint16_t yi, uint16_t xf, uint16_t yf, int16_t speed, uint8_t fr_rate) { |
278 |
int r; |
|
279 |
if ((r = get_permissions_first_mbyte())) |
|
280 |
panic("%s: sys_privctl (ADD MEM) failed: %d\n", __func__, r); |
|
281 | 278 |
|
282 |
if (vbe_get_mode_information(mode)) { |
|
283 |
printf("%s: failed to get information for mode %x.\n", __func__, mode); |
|
284 |
if (vg_exit()) printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
285 |
return 1; |
|
286 |
} |
|
287 |
|
|
288 |
map_vram(); // if function fails it aborts program |
|
289 |
|
|
290 |
if (set_graphics_mode(mode)) { |
|
291 |
printf("%s: failed to set graphic mode %x.\n", __func__, mode); |
|
292 |
if (vg_exit()) printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
293 |
return 1; |
|
294 |
} |
|
295 |
|
|
296 |
uint16_t W = get_XRes()/no_rectangles; |
|
297 |
uint16_t H = get_YRes()/no_rectangles; |
|
298 |
uint32_t color, R, G, B; |
|
299 |
for(uint8_t row = 0; row < no_rectangles; ++row){ |
|
300 |
for(uint8_t col = 0; col < no_rectangles; ++col){ |
|
301 |
if(get_bytes_pixel() == 1){ |
|
302 |
color = (first + (row * no_rectangles + col) * step) % (1 << get_bits_pixel()); |
|
303 |
}else{ |
|
304 |
R = (GET_RED(first) + col*step) % (1 << get_RedMaskSize()); |
|
305 |
G = (GET_GRE(first) + row*step) % (1 << get_GreenMaskSize()); |
|
306 |
B = (GET_BLU(first) + (col+row)*step) % (1 << get_BlueMaskSize()); |
|
307 |
color = SET_COLOR(R,G,B); |
|
308 |
} |
|
309 |
if (vg_draw_rectangle(col*W,row*H,W,H,color)) { |
|
310 |
if (vg_exit()) { |
|
311 |
printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
312 |
if (free_memory()) printf("%s: lm_free failed\n", __func__); |
|
313 |
} |
|
314 |
return 1; |
|
315 |
} |
|
316 |
} |
|
317 |
} |
|
318 |
|
|
319 |
/// loop stuff |
|
320 |
int ipc_status; |
|
321 |
message msg; |
|
322 |
/// Keyboard interrupt handling |
|
323 |
uint8_t kbc_irq_bit = KBC_IRQ; |
|
324 |
int kbc_id = 0; |
|
325 |
int kbc_irq = BIT(kbc_irq_bit); |
|
326 |
if (subscribe_kbc_interrupt(kbc_irq_bit, &kbc_id)) { |
|
327 |
if (vg_exit()) { |
|
328 |
printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
329 |
if (free_memory()) printf("%s: lm_free failed\n", __func__); |
|
330 |
} |
|
331 |
return 1; |
|
332 |
} |
|
333 |
/// cycle |
|
334 |
int good = 1; |
|
335 |
while (good) { |
|
336 |
/* Get a request message. */ |
|
337 |
if ((r = driver_receive(ANY, &msg, &ipc_status)) != 0) { |
|
338 |
printf("driver_receive failed with %d", r); |
|
339 |
continue; |
|
340 |
} |
|
341 |
if (is_ipc_notify(ipc_status)) { /* received notification */ |
|
342 |
switch (_ENDPOINT_P(msg.m_source)) { |
|
343 |
case HARDWARE: /* hardware interrupt notification */ |
|
344 |
if (msg.m_notify.interrupts & kbc_irq) { /* subscribed interrupt */ |
|
345 |
kbc_ih(); |
|
346 |
if (scancode[0] == ESC_BREAK_CODE) good = 0; |
|
347 |
} |
|
348 |
break; |
|
349 |
default: |
|
350 |
break; /* no other notifications expected: do nothing */ |
|
351 |
} |
|
352 |
} else { /* received standart message, not a notification */ |
|
353 |
/* no standart message expected: do nothing */ |
|
354 |
} |
|
355 |
} |
|
356 |
|
|
357 |
if (unsubscribe_interrupt(&kbc_id)) { |
|
358 |
if (vg_exit()) { |
|
359 |
printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
360 |
if (free_memory()) printf("%s: lm_free failed\n", __func__); |
|
361 |
} |
|
362 |
return 1; |
|
363 |
}; |
|
364 |
|
|
365 |
if (vg_exit()) { |
|
366 |
printf("%s: vg_exit failed to exit to text mode.\n", __func__); |
|
367 |
if (free_memory()) printf("%s: lm_free failed\n", __func__); |
|
368 |
return 1; |
|
369 |
} |
|
370 |
|
|
371 |
if (free_memory()) { |
|
372 |
printf("%s: lm_free failed\n", __func__); |
|
373 |
return 1; |
|
374 |
} |
|
375 |
|
|
376 |
return 0; |
|
279 |
return 1; |
|
377 | 280 |
} |
378 | 281 |
|
379 | 282 |
int(video_test_controller)() { |
Also available in: Unified diff