Car-like型移动机器人path planning中如何引入调头次数最少和必过点约束?

我在开发一个Car-like型移动机器人的路径规划问题时,遇到如下问题:
1、要求机器人必须通过设定好的路径点,例如有50个点位必须通过。
2、要求规划的路径调头次数最少。

初步设计采用A*或PRM算法。

img

请教大家如何在算法中引入以上2种约束?这样的设计是否可行?