mas_domestic_robotics
mas_domestic_robotics copied to clipboard
WIP: DMP Obstacle Avoidance
Summary of changes
This pull request addresses part of #230. It introduces an implementation of DMP obstacle avoidance as presented in this paper, where a force term computed from the positions of intermediate obstacles is added to the differential equation governing the evolution of the modeled variable.
The list of object positions is obtained by querying the KB interface for objects within a short distance from the robot.
TODO before merging
- [ ] Test and validate obstacle position to force term mapping on the HSR
- [ ] Test with varying object types and quantities