Thanks tom
i might actually post that control code after the season's end or sooner... it is actually extremely easy to use (=
Control loop:
PHP Code:
pid_control(&arm, des_arm_pos - cur_arm_pos);
pid_control(&wrist, des_wri_pos - cur_wri_pos);
solid and expandable =D