git.droids-corp.org
/
aversive.git
/ blobdiff
commit
grep
author
committer
pickaxe
?
search:
re
summary
|
shortlog
|
log
|
commit
|
commitdiff
|
tree
raw
|
inline
| side by side
back to old plate
[aversive.git]
/
projects
/
microb2010
/
mainboard
/
commands_traj.c
diff --git
a/projects/microb2010/mainboard/commands_traj.c
b/projects/microb2010/mainboard/commands_traj.c
index
e519d17
..
1898bd8
100644
(file)
--- a/
projects/microb2010/mainboard/commands_traj.c
+++ b/
projects/microb2010/mainboard/commands_traj.c
@@
-823,6
+823,7
@@
static void auto_position(void)
interrupt_traj_reset();
strat_get_speed(&old_spdd, &old_spda);
strat_set_speed(AUTOPOS_SPEED_FAST, AUTOPOS_SPEED_FAST);
interrupt_traj_reset();
strat_get_speed(&old_spdd, &old_spda);
strat_set_speed(AUTOPOS_SPEED_FAST, AUTOPOS_SPEED_FAST);
+ strat_set_acc(3, 3);
err = strat_calib(300, END_INTR|END_TRAJ|END_BLOCKING);
if (err == END_INTR)
err = strat_calib(300, END_INTR|END_TRAJ|END_BLOCKING);
if (err == END_INTR)
@@
-837,11
+838,13
@@
static void auto_position(void)
if (err == END_INTR)
goto intr;
if (err == END_INTR)
goto intr;
+ time_wait_ms(250);
trajectory_a_rel(&mainboard.traj, COLOR_A(-90));
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
trajectory_a_rel(&mainboard.traj, COLOR_A(-90));
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
+ time_wait_ms(250);
err = strat_calib(300, END_INTR|END_TRAJ|END_BLOCKING);
if (err == END_INTR)
goto intr;
err = strat_calib(300, END_INTR|END_TRAJ|END_BLOCKING);
if (err == END_INTR)
goto intr;
@@
-854,13
+857,13
@@
static void auto_position(void)
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
-
wait_ms(10
0);
+
time_wait_ms(25
0);
trajectory_a_rel(&mainboard.traj, COLOR_A(-110));
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
trajectory_a_rel(&mainboard.traj, COLOR_A(-110));
err = wait_traj_end(END_INTR|END_TRAJ);
if (err == END_INTR)
goto intr;
-
wait_ms(10
0);
+
time_wait_ms(25
0);
strat_set_speed(old_spdd, old_spda);
return;
strat_set_speed(old_spdd, old_spda);
return;