| 48,6 → 48,32 |
|---|
| } |
| } |
| |
| void action_stand_up(void) { |
| |
| static struct action_event e[6]; |
| int i,temp; |
| |
| for (i=0;i<5;i++) { |
| |
| kern_gettime(&(e[i].time)); |
| ADDUSEC2TIMESPEC(10000000,&(e[i].time)); |
| temp = i*1000000; |
| ADDUSEC2TIMESPEC(temp,&(e[i].time)); |
| |
| e[i].type = EVT_SET_MASK_LEG_ANGLE; |
| e[i].mask = 1 << i; |
| *(int *)(e[i].data) = 45 * 3600; |
| *(int *)(e[i].data + 4) = 0; |
| *(int *)(e[i].data + 8) = 0; |
| *(int *)(e[i].data + 12) = 0; |
| *(unsigned char *)(e[i].data + 16) = 7; |
| |
| insert_action_event(&(e[i])); |
| |
| } |
| |
| } |
| |
| int main(int argc, char **argv) |
| { |
| TIME seme; |
| 60,5 → 86,7 |
|---|
| init_send(); /* Comunication */ |
| init_key(); /* Keyboard */ |
| |
| action_stand_up(); |
| |
| return 0; |
| } |