{
static bool backward = false;
struct TrajectoryConstraints tc = trajectoryConstraintsDefault;
- tc.maxv *= 2;
- tc.maxacc *= 4;
- tc.maxangacc *= 4;
+// tc.maxv *= 2;
+// tc.maxacc *= 4;
+// tc.maxangacc *= 4;
/* Allocate new trajectory */
if (!backward) {
if (rv) error(1, errno, "robot_init() returned %d\n", rv);
robot.fsm.main.debug_states = 1;
- /*robot.fsm.motion.debug_states = 1;*/
+ robot.fsm.motion.debug_states = 1;
robot.fsm.main.transition_callback = trans_callback;
robot.fsm.motion.transition_callback = move_trans_callback;