80,15 → 80,27 |
|
e[6+i].type = EVT_SET_MASK_LEG_ANGLE; |
e[6+i].mask = 1 << i; |
*(int *)(e[6+i].data) = 0 * 3600; |
*(int *)(e[6+i].data) = 135 * 3600; |
*(int *)(e[6+i].data + 4) = 0; |
*(int *)(e[6+i].data + 8) = 0; |
*(unsigned char *)(e[i].data + 12) = 7; |
*(unsigned char *)(e[6+i].data + 12) = 7; |
|
insert_action_event(&(e[6+i])); |
|
} |
|
kern_gettime(&(e[15].time)); |
ADDUSEC2TIMESPEC(30000000,&(e[15].time)); |
|
e[15].type = EVT_SET_MASK_LEG_ANGLE; |
e[15].mask = 1 << 3; |
*(int *)(e[15].data) = 0; |
*(int *)(e[15].data + 4) = 0; |
*(int *)(e[15].data + 8) = -45 * 3600; |
*(unsigned char *)(e[15].data + 12) = 4; |
|
insert_action_event(&(e[15])); |
|
} |
|
int main(int argc, char **argv) |
100,6 → 112,8 |
|
sys_atrunlevel(my_close, NULL, RUNLEVEL_BEFORE_EXIT); |
|
clear(); |
|
init_send(); /* Comunication */ |
init_key(); /* Keyboard */ |
|