[发明专利]用于多关节蛇形机器人在水下避障的浸入边界控制方法

摘要

本发明公开的用于多关节蛇形机器人在水下避障的浸入边界控制方法，属于机器人控制领域。本发明的实现方法为：引入格子玻尔兹曼方法，取代传统求解流体的二阶偏微分方程模拟中的Navier‑Stokes方程，由概率统计学角度出发，从不同角度解决宏观与微观、离散与连续的关系，格子玻尔兹曼方法计算简单、易于并行实现，在处理比较复杂的边界条件时，能够实现宏观与微观的相互转化，利用浸入边界方法建立柔性的多关节蛇形机器人力源模型，采用流场中的欧拉变量去控制流体动态，利用力源模型的拉格朗日变量去控制多关节蛇形机器人的运动边界，用光滑的Delta近似函数通过分布节点力和差值速度来控制非线性流场力和力源边界的交互作用，实现多关节蛇形机器人的非线性控制。

主权项

1.用于多关节蛇形机器人在水下避障的浸入边界控制方法，其特征在于：包括如下步骤，步骤一：引入格子玻尔兹曼方法，取代传统求解流体的二阶偏微分方程模拟中的Navier‑Stokes方程，得到非线性的离散格子玻尔兹曼方程；步骤二：模拟的水下流体在空间入口和出口处呈现周期性边界变化过程中，严格保证整个系统的质量和动量守恒；模拟的水下流体在空间入口和出口处呈现周期性边界变化，水下流体入口和出口处的周期性边界能够严格保证整个系统的质量和动量守恒；步骤三：为了建立柔性多关节蛇形机器人力源模型，采用两套相互独立的坐标：即欧拉坐标和拉格朗日坐标，将“欧拉坐标”作为水下流体中的点，将“拉格朗日坐标”作为柔性多关节蛇形机器人力源边界点，并且“拉格朗日坐标”的运动规律由水下流体“欧拉坐标”和各相邻“拉格朗日坐标”之间的作用力共同控制；步骤四：采用改进的蛇形曲线方程公式(3)，创建一个多关节蛇形机器人各关节之间相互传递的蛇形曲线的弯曲力矩，设定多关节蛇形机器人的力源模型的关节数量和形状，M＝Asin(Fre·t+fi1+fi0)    (3)其中：其中A＝C0+C1+C2x2为摆动振幅，C0、C1、C2为常数，Fre为摆动频率，t为时间，fi0为尾部初始相位，fi1为有差异空间分布的初始相位；步骤五：采用Dirac‑delta近似函数D(xf)，将多关节蛇形机器人的拉格朗日点受到的弹性边界力分配到相应的周围预设数量的水下流体的欧拉点上，分布函数满足公式(4)；其中：f是浸入边界产生的单位力，F(s,t)是多关节蛇形机器人的拉格朗日点受到的弹性边界力，Ω是多关节蛇形机器人的浸入边界体，s是边界弧长，ds是格子宽度，x是欧拉点位置，X(s,t)是拉格朗日点的位置；步骤六：当水下流体的欧拉点上受到外力作用后，利用步骤一中建立的水下流体模型公式(1)(2)，进行一个步长的水下流体模型更新；步骤七：进行水下流体模型对力源模型的拉格朗日点更新，利用力源模型的拉格朗日变量去控制多关节蛇形机器人的力源边界。步骤八：根据实际工况设定迭代次数和时间步长，重复迭代步骤五到步骤七，用光滑的Delta近似函数通过分布节点力和差值速度来控制非线性流场力和力源边界的交互作用，实现多关节蛇形机器人的非线性控制。