Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Fmilano/cpt poinlaser hilti demo remove arm logic #105

Conversation

francescomilano172
Copy link

Removes arm-control logic from MabiLocalizer. Now the HAL routine advertises two services:

  • hal_take_measurement, that is expected to be called after the arm is moved, add takes laser measurements to be added to the factor graph, together with arm-odometry measurements;
  • high_acc_localize: performs the actual HAL routine, by optimizing over the factor graph. Returns the corrected robot-base pose in the world frame.

It is now assumed that when the HAL routine gets triggered, the arm is already in its initial pose. The latter is separately handled by the state machine.
The movements are now handled separately by the state machine. Note: this is a temporary commit, in a future version a separate service will be implemented to be called in order to take/add measurements after each movement of the routine.
The logic to handle arm movements are now handled separately by the state machine.
- Prototype of `initializeHALRoutine()`;
- Forgotten semicolon;
- Forgotten local variable declaration;
- Style fix.
- Add further documentation on the way the method should be used;
- Adapt return value based on success of the service call that turns the laser on;
- Consequently adapt the return value of `MabiLocalizer::takeMeasurement`;
- Add todo check.
The flag `initialized_hal_routine_` was wrongly set to true when the service turning the laser on failed to be executed.
@francescomilano172
Copy link
Author

@hermannsblum In case you wanted to take a quick look, these are the changes that I made

@ethzasl-jenkins
Copy link

Test FAILed.

1 similar comment
@ethzasl-jenkins
Copy link

Test FAILed.

@ethzasl-jenkins
Copy link

Test FAILed.

1 similar comment
@ethzasl-jenkins
Copy link

Test FAILed.

Change style of non-package include.
This way, the modules that use `cpt_pointlaser_loc_ros` do not need to build a custom empty message type.
@francescomilano172 francescomilano172 merged commit 93283eb into fmilano/cpt_pointlaser_hilti_demo Nov 6, 2020
@francescomilano172 francescomilano172 deleted the fmilano/cpt_poinlaser_hilti_demo_remove_arm_logic branch November 6, 2020 09:41
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

3 participants