| /demos/trunk/chimera/send.c |
|---|
| 377,8 → 377,8 |
| if (pid == NIL) { |
| perror("Could not create task <Get_Task>"); |
| sys_end(); |
| } else |
| task_activate(pid); |
| } //else |
| //task_activate(pid); |
| } |
| void init_send() |
| 392,6 → 392,13 |
| sem_init(&mx_status,0,1); |
| sem_init(&mx_servo,0,1); |
| for (i=0; i<16;i++) { |
| servo_set_max_angle_sec(COM_PORT,i,460000); |
| servo_set_min_angle_sec(COM_PORT,i,-460000); |
| } |
| for (i=0; i<6;i++) { |
| status.ang[i].a = 0; |