Algorithm 实施停车场管理系统

我正在尝试实施一个停车场管理系统。该停车场分为5个阶段，每个阶段有6个停车位（尺寸为5*2*3的3D矩阵），我们知道每时每刻至少有一个停车位空置。当一辆车进入停车场时，我们保存它的号码并为它分配一个空的停车位。当这辆车想要离开时，它的号码也会给出，所以我们应该搜索并找到它，然后移动其他的车以便送出这辆车。但是我们想做最少的运动来把车从停车场弄出来。如果停车位空置，每辆车都可以移动到相邻的上、下、后或前停车位

有人知道解决这个问题的算法吗

---

任何帮助都将不胜感激

请澄清一点“因此我们应该搜索并找到它，然后移动其他车辆以发送车辆”。按哪个顺序？有些地方可能会挡住另一个？当给出汽车号码时，我们会搜索汽车，当我们找到确切的位置时，根据空位，我们应该移动这辆汽车或其他汽车，以便汽车可以离开停车场。