Move robot out of obstacle (if any) before planning a new path

[SyrianSpock]

Sometimes the opponent is detected very close to the robot and it will think it's inside the opponent bounding box obstacle. The robot should be able to first get out of this situation before recomputing a path to its goal.

[antoinealb]

We also need to handle the case where we are in a static obstacle or outside the table bouding box.

[SyrianSpock]

One way to handle this:

• When blocked in obstacle, set a flag in the robot state
• Provide GOAP with a safe way to get itself out of the blocked state
• Let GOAP do the work of actually getting out when needed

[antoinealb]

Maybe as a source of inspiration, how microb (authors of aversive) did it in 2009: https://github.com/onitake/aversive/blob/master/projects/microb2009/mainboard/strat_avoid.c#L233