- tock = rt_timer_read();
- add_tick(ticks, tock-tick);
-
- // Tocks waiting period
- if(tocks[TICKS] < ticks[TICKS]){
- // sleep until the arm is most left
- rt_task_sleep(tocks[TICKS]/2);
- rt_task_create(&drawtask, NULL, 0, 50, 0);
- period = ticks[TICKS]+tocks[TICKS];
- rt_task_start(&drawtask, &taskd, &period);
- rt_printf("tocks is the short stretch\n");
- }
+ tock = rt_timer_read();
+ add_tick(ticks, tock-tick);
+
+ // Tocks waiting period
+ if(tocks[TICKS] < ticks[TICKS]){
+ // sleep until the arm is most left
+ rt_task_sleep(tocks[TICKS]/2);
+ rt_task_create(&drawtask, NULL, 0, 50, 0);
+ period = ticks[TICKS]+tocks[TICKS];
+ rt_task_start(&drawtask, &taskd, &period);
+ rt_printf("tocks is the short stretch\n");
+ }