robot.laser.aeval_sigma = DEG2RAD(4);
robot.mcl = mcl_laser_init(&robot.laser, 1000);
- robot.orte.laser_cmd.speed = LASER_DRIVE_ON;
- ORTEPublicationSend(robot.orte.publication_laser_cmd);
-
robot.fsm[FSM_ID_MOTION].state = &fsm_state_motion_init;
robot.fsm[FSM_ID_LOC].state = &fsm_state_loc_init;
robot.orte.laser_cmd.speed = LASER_DRIVE_OFF;
ORTEPublicationSend(robot.orte.publication_laser_cmd);
+ ORTEPublicationSend(robot.orte.publication_laser_cmd);
+
open_back_door();
open_bottom_door();
off_bagr();