[发明专利]一种基于改进极限学习机的巡逻车高精度循迹方法

权利要求书

1.基于改进极限学习机的巡逻车高精度循迹方法，具体步骤如下，其特征在于：

步骤1，建立巡逻车运动场地的坐标系：使用设备采集运动场地的经度、纬度和高度信息，并将采集数据的WGS-84坐标转换为该运动场地的坐标系；

步骤2，规划巡逻车的运动轨迹：在巡逻车运动场地坐标系的基础上，根据场地信息、巡逻车起点和终点，通过遗传算法计算出一条巡逻车最优路径，在坐标系中拟合出巡逻车理想的轨迹曲线；

步骤3，获取巡逻车当前的定位数据以及电机运行数据：通过导航系统解算获取巡逻车当前的位置信息，同时利用编码器和ADC模块获取电机转速和电机电流数据，并通过车辆动力学模型求解巡逻车在坐标系下的速度值；

步骤4，设计改进极限学习机的高精度循迹算法：构建改进后的巡逻车循迹极限学习机网络，把根据动力学模型解算后的电机速度、电机电流和巡逻车下一时刻位置值作为输入，所对应的下一时刻电机速度和电流作为输出，训练改进的极限学习机网络；

步骤5，根据运动轨迹和循迹算法来控制巡逻车的高精度运行，同时开启巡逻车驾驶中断，当安全距离内出现巡逻异常时，系统启动中断处理机制，日志模块记录车载终端的异常情况。

2.根据权利要求1所述的基于改进极限学习机的巡逻车高精度循迹方法，其特征在于：步骤1中建立巡逻车运动场地的坐标系的过程可以表示为：

设采集数据的WGS-84坐标为(θ，λ，h)，其中为θ经度坐标、λ为纬度坐标、h为高度坐标，通过下式将WGS-84坐标转换为直角坐标(x’，y’，z’)：

式中，e为地球的第一偏心率，N为曲率半径，再把直角坐标乘上转换系数L，将直角坐标(x’，y’，z’)转换为巡逻车实际使用的坐标(x，y，z)，转换系数L如下：

3.根据权利要求1所述的基于改进极限学习机的巡逻车高精度循迹方法，其特征在于：步骤4中设计改进极限学习机高精度循迹算法的过程可以表示为：

步骤4.1先随机初始化极限学习机输入权重w_i，i＝1，2，…，l，输入偏置b_i，i＝1，2，…，l，其中l是网络隐含层的节点数；

步骤4.2将解算的巡逻车下一时刻位置、当前速度和当前电流作为网络输入数据n_i，i＝1，2，...，n，其中n是输入层网络层数，下一时刻速度和电流作为输出O_k，k＝1，2，构建极限学习机模型：

其中，β_j是输出权重，f()是极限学习机的激活函数；

步骤4.3求解极限学习机网络参数，极限学习机网络的学习目标是让网络输出的误差最小，即令损失函数最小，损失函数表达式为：

E＝∑(O_k-O′_k)² (4)

式中，O’_k是对应速度和电流的实测值，为了令损失函数最小，可令网络输出值O_k直接等于实测值，再求出输出权重β_j，即：

β_j＝piny(H)·L (5)

式中，L是输入向量对应的输出层矩阵，pinv为求解矩阵的伪逆矩阵，H是隐含层的输出层矩阵；

步骤4.4在控制电机速度和电流的过程中，通过卷积层映射对极限学习机的权重和偏置进行在线微调，将权重和偏置数据组成混合矩阵D，利用卷积层进行降维：

c＝conv₁D (6)

步骤4.5通过sigmoid激活函数得到权重和偏置映射M：

M＝sigmoid(c) (7)

并利用卷积层和tanh激活函数对M进行归一化操作，生成权重和偏置映射权重：

σ＝tanh(conv₂M) (8)

式中，conv₁和conv₂表示卷积操作；

步骤4.6最终根据映射权重对权重和偏置进行微调，获取微调后的权重和偏置混合矩阵D′

D′＝σ×D (9)

最终获得极限学习机的输入权重、偏置和输出权重，得到训练完成的极限学习机模型，其中极限学习机的输入权重、偏置和输出权重可在线调整。

4.根据权利要求1所述的基于改进极限学习机的巡逻车高精度循迹方法，其特征在于：步骤5中根据运动轨迹和循迹算法来控制巡逻车高精度运行的过程可以表示为：

车体采用四个直流电机驱动的方式，并通过光电编码器测速装置、PID控制和PWM波输出完成对电机的合理调速；本发明的PID控制选择增量式PID，分为电流增量式PID、速度环增量式PID和位置环增量式PID，同时为了快速、高精度的控制巡逻车，在PID控制电流和转速的输出端叠加改进了极限学习机模型输出值，以减小电机运行时的误差；

Posout＝ELJMout+PIDout (10)

式中，Posout为本发明巡逻车高精度循迹算法针对电机速度和电流的实际输出值，ELMout为改进极限学习机的输出值，PIDout为增量式PID的输出值。