机器人仿真环境控制脚本 - Lua 脚本分析 - 常规

该代码是一个 Lua 脚本，用于控制机器人在仿真环境中移动。以下是对代码的逐句分析：

定义了一个名为 'run' 的函数，该函数接受两个参数 'P' 和 'D'。
创建了一个空表 'data2'，'PD'、'error' 和 'previousError' 变量并初始化为 0。
使用一个循环，读取 'floorSensorHandles' 中的视觉传感器数据，并将其存储在 'data2' 表中。
如果 'data2[4]' 小于 0.73，则将 'data2[3]' 设置为 0。
如果 'data2[2]' 小于 0.73，则将 'data2[1]' 设置为 0。
如果 'data2[2]' 小于 'data2[4]'，则执行以下操作：
- 如果 'data2[3]' 小于 'data2[1]'，则计算 'error' 为 'math.abs(data2[5]-0.095)+math.abs(data2[3]-0.85)+math.abs(data2[2]-0.85)'。
- 否则，计算 'error' 为 'math.abs(data2[5]-0.095)+math.abs(data2[1]-0.85)+math.abs(data2[2]-0.85)'。
否则，执行以下操作：
- 如果 'data2[3]' 小于 'data2[1]'，则计算 'error' 为 'math.abs(data2[5]-0.095)+math.abs(data2[3]-0.85)+math.abs(data2[4]-0.85)'。
- 否则，计算 'error' 为 'math.abs(data2[5]-0.095)+math.abs(data2[1]-0.85)+math.abs(data2[4]-0.85)'。
计算 'PD' 为 'P' 乘以 'error' 加上 'D' 乘以 'error' 减去 'previousError'。
更新 'previousError' 为当前的 'error' 值。
更新 'previousdata' 为当前的 'data2' 值。
如果 'error' 小于 0.2，则将 'rightV' 和 'leftV' 都设置为 'speed'，并将 'previousError' 设置为 0。
否则，如果 'data2[3]' 小于 0.75 或 'data2[4]' 小于 0.75，则将 'rightV' 设置为 'speed' 加上 'PD' 乘以 'speed'，将 'leftV' 设置为 'speed' 减去 'PD' 乘以 'speed'。
否则，如果 'data2[1]' 小于 0.75 或 'data2[2]' 小于 0.75，则将 'rightV' 设置为 'speed' 减去 'PD' 乘以 'speed'，将 'leftV' 设置为 'speed' 加上 'PD' 乘以 'speed'。
使用 'sim.setJointTargetVelocity' 函数将 'leftmotor' 和 'rightmotor' 的目标速度设置为 'leftV' 和 'rightV'。
定义了一个名为 'sysCall_threadmain' 的函数。
获取左右电机和车辆的句柄。
获取地板传感器的句柄，并存储在 'floorSensorHandles' 表中。
定义了一些变量和表。
设置车辆速度为 -5。
设置 'back' 变量为 -1。
初始化 'previousError' 为 0。
初始化 'previousdata' 为空表。
设置 'flag' 表为全 0。
设置 'occupy2' 信号为 1。
停止左右电机。
设置 'arrive2' 信号为 1。
等待 'finish2' 信号。
清除 'finish2' 信号。
进入一个无限循环，直到 'occupy3' 信号不存在。
清除 'occupy2' 信号。
设置 'flag' 表为全 0，除了第二个元素为 1。
在仿真环境未停止之前，执行以下操作：

获取车辆的位置。
如果车辆位置接近 'stop[1]' 的位置，并且 'flag[1]' 为 0，则执行以下操作：
- 设置 'occupy1' 信号为 1。
- 停止左右电机。
- 等待 0.8 秒。
- 设置 'arrive1' 信号为 1。
- 等待 'finish1' 信号。
- 清除 'finish1' 信号。
- 进入一个无限循环，直到 'occupy2' 信号不存在。
- 清除 'occupy1' 信号。
- 设置 'flag' 表为 1,0,0,0,0,0,0,0。
如果车辆位置接近 'stop[2]' 的位置，并且 'flag[2]' 为 0，则执行以下操作：
- 设置 'occupy2' 信号为 1。
- 停止左右电机。
- 等待 0.8 秒。
- 设置 'arrive2' 信号为 1。
- 等待 'finish2' 信号。
- 清除 'finish2' 信号。
- 进入一个无限循环，直到 'occupy3' 信号不存在。
- 清除 'occupy2' 信号。
- 设置 'flag' 表为 0,1,0,0,0,0,0,0。
如果车辆位置接近 'stop[5]' 的位置，并且 'flag[5]' 为 0，则执行以下操作：
- 设置 'occupy5' 信号为 1。
- 停止左右电机。
- 等待 0.8 秒。
- 设置 'arrive5' 信号为 1。
- 等待 'finish5' 信号。
- 清除 'finish5' 信号。
- 进入一个无限循环，直到 'occupy6' 信号不存在。
- 清除 'occupy5' 信号。
- 设置 'flag' 表为 0,0,0,0,1,0,0,0。
如果车辆位置接近 'stop[6]' 的位置，并且 'flag[6]' 为 0，则执行以下操作：
- 设置 'occupy6' 信号为 1。
- 停止左右电机。
- 等待 0.8 秒。
- 设置 'arrive6' 信号为 1。
- 等待 'finish6' 信号。
- 清除 'finish6' 信号。
- 进入一个无限循环，直到 'occupy7' 信号不存在。
- 清除 'occupy6' 信号。
- 设置 'flag' 表为 0,0,0,0,0,1,0,0。
如果车辆位置接近 'stop[3]' 的位置，并且 'flag[3]' 为 0，则执行以下操作：
- 设置 'occupy3' 信号为 1。
- 如果 'occupy4' 信号不存在，则清除 'occupy3' 信号。
- 否则，停止左右电机。
- 进入一个无限循环，直到 'occupy4' 信号不存在。
- 清除 'occupy3' 信号。
- 设置 'flag' 表为 0,0,1,0,0,0,0,0。
如果车辆位置接近 'stop[4]' 的位置，并且 'flag[4]' 为 0，则执行以下操作：
- 设置 'occupy4' 信号为 1。
- 如果 'occupy5' 信号不存在，则清除 'occupy4' 信号。
- 否则，停止左右电机。
- 进入一个无限循环，直到 'occupy5' 信号不存在。
- 清除 'occupy4' 信号。
- 设置 'flag' 表为 0,0,0,1,0,0,0,0。
如果车辆位置接近 'stop[7]' 的位置，并且 'flag[7]' 为 0，则执行以下操作：
- 设置 'occupy7' 信号为 1。
- 如果 'occupy8' 信号不存在，则清除 'occupy7' 信号。
- 否则，停止左右电机。
- 进入一个无限循环，直到 'occupy8' 信号不存在。
- 清除 'occupy7' 信号。
- 设置 'flag' 表为 0,0,0,0,0,0,1,0。
如果车辆位置接近 'stop[8]' 的位置，并且 'flag[8]' 为 0，则执行以下操作：
- 设置 'occupy8' 信号为 1。
- 如果 'occupy1' 信号不存在，则清除 'occupy8' 信号。
- 否则，停止左右电机。
- 进入一个无限循环，直到 'occupy1' 信号不存在。
- 清除 'occupy8' 信号。
- 设置 'flag' 表为 0,0,0,0,0,0,0,1。
执行 'run(0.2, 0.05)' 函数。

该脚本使用 Lua 语言，并利用了 CoppeliaSim 的 API 来控制机器人模型。脚本中定义了多个函数和变量，用于处理传感器数据、计算运动参数、控制电机速度和管理机器人行为。脚本通过循环不断读取传感器数据，并根据这些数据计算控制参数，并最终控制机器人的运动。脚本还使用信号机制来实现不同模块之间的通信，并通过 'sysCall_threadmain' 函数来管理脚本的执行流程。