一种电磁轨道式移动机器人的运动控制系统及控制方法

摘要

一种电磁轨道式移动机器人的运动控制系统及控制方法，该系统中的发射线圈和接收线圈构成能量传输通道并复用为通信装置的天线构成通信系统，车载控制器将从速度传感器采集回来的速度信号发送给发射控制系统，发射控制系统将当前速度与给定速度相比较，得到误差后利用PID算法控制发射电路的功率，经发射电路控制驱动电机的转速；幅值检测器和补偿电容组构成谐振频率自适应控制系统，幅值检测器检测当前接收线圈谐振电压的幅值并将采集的幅值转换成数字量传递给车载控制器，车载控制器将补偿电容组中的一个以上小容量电容接入或撤出电路。该方法基于上述控制系统。本发明具有结构简单紧凑、操作简便、控制精度高、通信质量好、可靠性高等优点。

主权项

一种电磁轨道式移动机器人的运动控制系统，其特征在于，包括发射线圈（1）、接收线圈（2）、发射电路（3）、通信装置（4）、发射控制系统（5）、车载控制器（6）、幅值检测器（7）、补偿电容组（8）和速度传感器（9）；所述发射线圈（1）和接收线圈（2）构成能量传输通道并复用为通信装置（4）的天线构成通信系统，所述发射控制系统（5）与车载控制器（6）之间通过通信装置（4）、发射线圈（1）、接收线圈（2）进行数据传递，所述车载控制器（6）将从速度传感器（9）采集回来的速度信号发送给发射控制系统（5），所述发射控制系统（5）将当前速度与设置好的给定速度相比较，得到误差之后利用PID算法控制发射电路（3）的功率，经发射电路（3）控制驱动电机10的转速；所述幅值检测器（7）和补偿电容组（8）构成谐振频率自适应控制系统，所述幅值检测器（7）不断的检测当前接收线圈（2）谐振电压的幅值并将采集的幅值转换成数字量传递给车载控制器（6），所述车载控制器（6）将补偿电容组（8）中的一个以上小容量电容接入或撤出电路。