Full integration

[bhunecke]

Create the FSM that runs the full task. This should integrate:

• The detection of the door(areas)
• Detection of doorparts (specifically select window motor and control unit as pickable objects)
• Scanning motion (trajectory) with screw detection
• Table detection wit detection of empty space
• The arm motion itself together with all of these tasks (especially different pick motions for different objects)

Whiteboard for reference: