一种磁性微纳机器人的自主导航与控制方法与流程

技术特征：
1.一种磁性微纳机器人的自主导航与控制方法，其特征在于，所述磁性微纳机器人的自主导航与控制系统包括形成闭环控制的交流电流源、三轴亥姆霍兹线圈、磁性微纳机器人、显微镜和上位机；所述方法包括：建立所述磁性微纳机器人的车辆等效模型，将对所述磁性微纳机器人的控制等效为对微车的转向角和油门的控制；对所述显微镜采集的图像进行图像特征的提取、匹配和融合，从局部地图扩充到全局地图，并利用语义分割和目标检测方法获取所述磁性微纳机器人的状态信息和所处环境信息；利用改进的rrt
‑
connet算法，引入边界扩充和曲线平滑算法对原始轨迹进行处理，得到所述磁性微纳机器人在全局地图的最优避障路径；基于所述等效模型和状态信息，对所述磁性微纳机器人进行运动学建模得到状态空间方程；利用所述状态空间方程设计基于强化学习的轨迹跟踪控制器，所述轨迹跟踪控制器依据状态信息输出控制信号至所述交流电流源，从而改变空间旋转磁场以跟踪所述最优避障路径，实现对所述磁性微纳机器人的闭环控制。2.根据权利要求1所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述利用改进的rrt
‑
connet算法，引入边界扩充和曲线平滑算法对原始轨迹进行处理，得到所述磁性微纳机器人在全局地图的最优避障路径，包括：通过像素语义图计算所述磁性微纳机器人的设定工作环境的可驱动区域的边界，然后根据所述磁性微纳机器人在像素上的大小扩展所述可驱动区域的边界，将扩展结果以外的区域作为非驾驶区，可驱动区域边界内部为驾驶区；通过rrt
‑
connet算法对规划路径进行节点细化，以提取关键地标，然后使用b样条函数优化由所述关键地标形成的局部路径以产生具有连续曲率的平滑路径作为所述最优避障路径。3.根据权利要求1所述的磁性微纳机器人的自主导航与控制方法，其特征在于，基于所述磁性微纳机器人的运动状态，定义所述状态空间方程为：其中，δ表示微车的转向角，τ表示微车的油门；e
θ
表示微车与最优避障路径之间的角度差，是一阶导数；e
x
、e
y
分别是x和y轴方向的位置误差，和是相应的一阶导数，和是相应的二阶导数，导数用于向轨迹跟踪控制器提供时间信息；χ中包含在最优避障路径中当前位置的后两个路径点的二维坐标，s表示维度为14的状态空间方程。4.根据权利要求1所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述利用所述状态空间方程设计基于强化学习的轨迹跟踪控制器，包括：所述基于强化学习的轨迹跟踪控制器由三种神经网络组成，包括两个软q函数q
θ1
(s
t
,a
t
)、q
θ2
(s
t
,a
t
)和可处理策略其中，s
t
表示t时刻状态空间方程的状态信息，a
t
表示t时刻的动作空间，三种神经网络的参数是θ
1、2
和φ0；
算法流程如下：首先，观察当前时刻状态空间方程的14维状态，然后通过策略网络将状态信息转移到具有完全连接层的2维动作；从输出分布中采样动作，并使用tanh激活函数将其归一化为[
‑
1,1]，所述采样动作将被进一步映射和平滑以与环境交互；当获得下一个状态信息s
t 1
和r(s
t
,a
t
)时，参数(s
t
,a
t
,r(s
t
,a
t
),s
t 1
)被存储到缓冲区中，在训练过程中会重复进行上述交互和存储的过程；在训练结束时，当过渡次数大于设置阈值时，分别使用函数j
q
(θ
i
)和j
π
(φ0)更新网络，重复整个算法流程，直到得到最佳策略为止。5.根据权利要求1所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述轨迹跟踪控制器依据状态信息输出控制信号至所述交流电流源，从而改变空间旋转磁场以跟踪所述最优避障路径，包括：向所述轨迹跟踪控制器输入当前时刻的状态空间方程，输出包括转向角和油门控制量的动作空间；将所述动作空间等效为所述空间旋转磁场的旋转角度，对当前时刻的空间旋转磁场值进行磁场转换，得到下一时刻旋转后的空间旋转磁场值；根据所述下一时刻旋转后的空间旋转磁场值计算得到线圈的三轴电流，进而转换为交流电对应的频率和幅值作为控制信号输入至所述交流电流源。6.根据权利要求5所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述将所述动作空间等效为所述空间旋转磁场的旋转角度，对当前时刻的空间旋转磁场值进行磁场转换，得到下一时刻旋转后的空间旋转磁场值，包括：采用四元数方法推导所述空间旋转磁场的产生，对于空间磁场矢量om，o:(0,0,0)表示在空间的原点，设所述当前时刻的空间旋转磁场值m为(x,y,z)，所述下一时刻旋转后的空间旋转磁场值m’为(x’,y’,z’)；空间三维旋转视为绕三个基本轴的旋转组合，绕三个基本轴的旋转角度是其中，将旋转矢量的旋转角度等效为微车的转向角控制量，将旋转矢量的旋转角度φ等效为微车的油门控制量，且φ＝∫ωtdt，ω表示旋转角速度；旋转前四元数坐标m[0(x,y,z)]是通过四元数方法展开磁场值(x,y,z)后得到的，求解旋转后四元数坐标m’[0(x’,y’,z’)]的过程如下：q＝[q0(q
1 q
2 q3)]q
‑1＝[q0(
‑
q1ꢀ‑
q2ꢀ‑
q3)]其中，q代表单位四元数；设三个基本轴的旋转顺序依次为z、y、x，则旋转过程定义为：qm＝[q0(q
1 q
2 q3)][0(x,y,z)]＝[w1(v1,v2,v3)]所述旋转后四元数坐标m’基于单位四元数与旋转的关系，定义为：
m
′
＝qmq
‑1＝[w1(v1,v2,v3)][q0(
‑
q1ꢀ‑
q2ꢀ‑
q3)]＝[w0(u,v,w)]其中，中间变量分别表示为：中间变量分别表示为：则所述下一时刻旋转后的空间旋转磁场值m’表示为：7.根据权利要求5所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述根据所述下一时刻旋转后的空间旋转磁场值计算得到线圈的三轴电流，其中，计算公式为：其中，b
e
记为所述空间旋转磁场，μ0表示空间中的磁导率，n
k
(k＝x,y,z)表示所述三轴亥姆霍兹线圈中每个线圈的匝数，i
k
(k＝x,y,z)表示三轴电流，a
k
(k＝x,y,z)表示所述三轴亥姆霍兹线圈中每个线圈的半径；通过所述空间旋转磁场与机器人的磁矩的乘积产生的磁转矩来操纵所述磁性微纳机器人按照所述最优避障路径运动，所述磁转矩的表达式为：t
e
＝m
×
b
e
，其中m表示磁矩。8.根据权利要求1
‑
7任一所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述方法还包括：基于最优避障路径跟随和非冲突的目标，设计回报函数用来评估所述轨迹跟踪控制器的性能，设计回报函数r
eθ
、r
ex
、r
ey
和r
co
，表示如下：表示如下：表示如下：其中，r
eθ
、r
ex
、r
ey
表示距离目标点误差的回报函数，实现目标跟踪和自主规划功能；r
co
表示机器人避开非驾驶区的回报函数，对静态避障和动态避障同时有效，以所述磁性微纳
机器人的直径作为圆的半径，圆的面积为所述非驾驶区与圆相交的面积为s
co
，则总回报累积为：r＝∑(r
eθ
(t) r
ex
(t) r
ey
(t) r
co
(t))。9.根据权利要求1
‑
7任一所述的磁性微纳机器人的自主导航与控制方法，其特征在于，所述磁性微纳机器人采用磁珠，材料为钕铁硼材料、半径为r
m
，所述磁性微纳机器人在设定工作环境中运动，所述设定工作环境为含有流体的微流控芯片或者培养皿。10.根据权利要求9所述的磁性微纳机器人的自主导航与控制方法，其特征在于，分析所述磁性微纳机器人在所述设定工作环境下的滚动条件，包括：在所述空间旋转磁场下，所述磁性微纳机器人受到磁转矩t
e
，并将所述磁转矩t
e
表示为切向力f
t
，所述磁性微纳机器人还受到地面摩擦力、流体阻力f
p
、浮力f
b
和自身重力g；其中：f
t
＝t
e
/r
m
f
s
＝μ(g
‑
f
b
)f
r
＝σ(g
‑
f
b
)f
s
为静摩擦力，f
r
为滚动摩擦力，μ和σ分别为静摩擦系数和滚动摩擦系数；则所述磁性微纳机器人的滚动条件为：

技术总结
本发明公开了一种磁性微纳机器人的自主导航与控制方法，涉及微纳机器人技术领域，该方法通过交流电流源来驱动三轴亥姆霍兹线圈产生空间旋转磁场以驱动磁性微纳机器人运动，采用显微镜对磁性微纳机器人的工作环境及其位置进行反馈，建立磁性微纳机器人的车辆等效模型，降低了控制的复杂度，然后基于边界扩充和路径平滑改进了RRT


技术研发人员：樊启高 张鹏松 谢林柏 黄文涛 朱一昕 毕恺韬 贾捷
受保护的技术使用者：江南大学
技术研发日：2021.08.19
技术公布日：2021/11/21