Robocup 2022: Take out the garbage

[PetervDooren]

Current state:

Todo:

[P-ict0]

Current state:

Robot correctly drives and positions itself in front of the first trashbin, attempt to grab the trash, lifts it and force drives backwards (hardcoded). Drives to the drop off area and crashes

Todo:

• (Josja) Fix the command "hero-challenge-take-out-the-garbage" (has to be rosrun manually when using physical robot).
• (Rodrigo) Find correct distance to trash bin (radius) in control_to_trash_bin.py
• (Josja) Challenge crashes when dropping trash due to missing entity in arm
• ...

[JosjaG]

I just did a complete successful run of the challenge, so the main flow of the challenge is working!! 🥳

[P-ict0]

Just realized the radius parameter in control_to_trash_bin.py (also called in pick_up.py) is irrelevant since in state "GO_BIN" we tell hero to go in front of the trash can.

We either have to change "GO_BIN" to be able to chose what distance should hero position itself to the trash can, or rewrite control_to_trash_bin.py with the default distance hero positions itself when NavigateToSymbolic(...) is called

edit:
I have some ideas but I don't know how to start putting them in place by myself. I suggest talking about it next team evening to find a solution and to nudge me in the right direction for the first steps

[MatthijsBurgh]

force_drive is broken in combination with this challenge. @P-ict0 is taking a look before next dev evening.

[PetervDooren]

Some shortcomings of the current implementation:
Lots of magic numbers to determine the pose of the robot with respect to the trashbin. I think we can do better than this. It would also lower tuning time when adjusting to a new bin.
Trashbin size was incorrect in the worldmodel tue-robotics/ed_object_models#100 should fix this
Currently the arm moves down until it feels a force or it reaches a timeout. We can also make it so that we can adjust the distance at which we close the gripper anyway.