CN112269389A - 一种多功能乘务服务智能机器车系统及其控制方法 - Google Patents
一种多功能乘务服务智能机器车系统及其控制方法 Download PDFInfo
- Publication number
- CN112269389A CN112269389A CN202011290129.2A CN202011290129A CN112269389A CN 112269389 A CN112269389 A CN 112269389A CN 202011290129 A CN202011290129 A CN 202011290129A CN 112269389 A CN112269389 A CN 112269389A
- Authority
- CN
- China
- Prior art keywords
- service
- module
- intelligent
- vehicle
- intelligent vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 46
- 238000001514 detection method Methods 0.000 claims abstract description 43
- 238000012384 transportation and delivery Methods 0.000 claims abstract description 25
- 238000004891 communication Methods 0.000 claims abstract description 14
- 235000013305 food Nutrition 0.000 claims abstract description 14
- 230000008569 process Effects 0.000 claims abstract description 8
- 235000012054 meals Nutrition 0.000 claims description 11
- 230000003993 interaction Effects 0.000 claims description 9
- 238000013461 design Methods 0.000 claims description 7
- 238000012795 verification Methods 0.000 claims description 7
- 230000004044 response Effects 0.000 claims description 6
- 229920000535 Tan II Polymers 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 239000004576 sand Substances 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 2
- 238000009835 boiling Methods 0.000 abstract 1
- 238000007689 inspection Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 238000007726 management method Methods 0.000 description 3
- 230000002452 interceptive effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 208000027744 congestion Diseases 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000013439 planning Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种多功能乘务服务智能机器车系统及其控制方法,该系统包括智能机器车,设置在智能机器车内的控制模块、身份证识别模块、压力检测模块、磁传感器模块、超声波模块和无线通讯模块,以及云端;机器车可接受云端传来的服务信息,在到达规定地点后可自动打开送餐门或开水门,并返回初始位置。系统可通过身份证识别模块和无线通讯模块进行云端的车票检验,完成高效、无接触的检票服务。该系统主要优势体现于采用身份证识别检票,减少车票打印流程,减少纸张使用;配备智能送餐送水系统,实现送餐送水自动化控制。本发明可以准确、安全、高效的完成服务,实时性高且应用方便。
Description
技术领域
本发明涉及智能机器人技术领域,尤其涉及一种多功能乘务服务智能机器车系统及其控制方法。
背景技术
目前大多数火车上的乘务服务内容都太过于传统,如人工检票,餐车供餐,接开水等。人工检票需要的人力工作量大,消耗时间长,还容易出现逃票漏票现象;餐车供餐的供餐量少,且由于火车过道狭窄,容易造成人员拥挤,大部分乘客都更倾向于使用点餐app进行提前点餐送餐,导致难以管理;接开水的服务需要乘客自行前往车厢底部自行接水,容易造成人员拥挤。且人工服务的服务内容单一。
采用传统的人工送餐模式,不仅会造成列车拥挤,难以管理,还会导致站内资源得不到有效利用,和某些操作复杂等问题。而如今智能化的推行不仅能解决人力投入量大的问题,还能减少乘客与乘务员的工作量,提升乘务服务的效率和降低可能存在的拥挤风险。
发明内容
本发明要解决的技术问题在于针对现有技术中的缺陷,提供一种多功能乘务服务智能机器车系统及其控制方法。
本发明解决其技术问题所采用的技术方案是:
本发明提供一种多功能乘务服务智能机器车系统,该系统包括智能机器车,设置在智能机器车内的控制模块、身份证识别模块、压力检测模块、磁传感器模块、超声波模块和无线通讯模块,以及云端;其中:
智能机器车,其车身上设置有开水出水系统和送餐系统;
身份证识别模块,用于检测身份证信息,并通过无线通讯模块将身份证信息发送到云端进行身份核实;
压力检测模块,用于检测开水出水系统的水压,通过控制模块接收压力检测模块和云端的数据,并对存储在控制模块中的压力参数值进行调用和比较,进而对开水出水系统进行控制;
磁传感器模块,用于采集电磁信号进行路线寻迹,通过控制模块接收云端发送的位置信息,并读取磁传感器模块采集到的电磁信号后进行寻迹前往服务位置;
超声波模块,用于在智能机器车进行路线寻迹时实时进行障碍物检测,当检测到障碍物信息时,通过控制模块控制智能机器车停止;
控制模块,还用于对开水出水系统和送餐系统的步进电机进行控制,在抵达服务位置后,实现送餐门和开水门的开启和关闭操作,并进行语音识别的人机交互。
进一步地,本发明的所述控制模块采用STM32F407ZGT6核心控制模块。
进一步地,本发明的所述控制模块在一个控制周期内对接收信息和寻迹路线行进规划的调控过程中,首先初始化控制模块内部所存储的地点位置变量的设定值,这些设定值被保存在其内部的一块特定的RAM区域中,其后从云端收到地点数据并进行数据解码,解码后从RAM中调取初始位置变量的设定值与当前值进行比较,计算出偏差值,利用该偏差值计算出系统执行器的所需的前进距离,最后根据距离寻迹前往相应地点。
进一步地,本发明的所述云端的服务器在列车出站后,将下车人数和上车人数的数据存入数据库中,并向控制模块发送需要检票的位置信息,智能车根据位置信息前往指定位置进行身份证检票。
进一步地,本发明的该系统还包括乘客客户端,乘客在客户端中选择自己需要的相应服务内容,服务数据将传输给云端的服务器存入数据库中,并将服务信息和服务位置数据传输给智能车系统,智能车采用磁传感的方法进行寻迹,超声波检测进行避障处理,在抵达指定位置后,智能车系统控制不同部件实现不同的服务内容。
本发明提供一种多功能乘务服务智能机器车系统的控制方法,包括以下步骤:
步骤1、判断智能车系统当前所处的工作模式,若未选择服务模式,系统默认进入检票模式,执行步骤2;若系统选择服务模式,执行步骤3;
步骤2、检票模式:接收由云端传来的新上乘客的位置信息,智能车通过路径寻迹和避障识别达到目的地,然后进行语音提示身份证检票,检测完后将身份证信息上传云端进行检索核对,核对完成后语音提示检票成功,智能车回到原位;
步骤3、服务模式:乘客通过客户端将需求服务信息传递给云端服务器,云端服务器将检索的车票验证信息传输给智能车系统,云端服务器的数据库将用户的身份信息及需求服务信息有效储存并与云端服务器通信;
步骤4、云端服务器向智能车系统发送服务信息和服务位置,智能车通过路径寻迹和避障识别达到服务位置,并判断服务信息的类型;
步骤5、若为送水服务,则控制步进电机进行出水门的开门操作,并发出语音提示;若为送餐服务,则控制步进电机进行送餐门的开门操作,并发出语音提示;
步骤6、完成服务模式后,智能车回到原位。
进一步地,本发明的该方法中进行路径寻迹的算法具体为:
保持智能车在列车上直线行驶取,使当前智能车行进的导航角与预期相同,保持与过道的左右间隔相等;计算导航角的方法为:
计算地球磁场和导航角之间的关系,将该点的地磁场Hearth分解为两个平行于当地水平面的分量和一个垂直于当地水平面的分量;
在水平方向上磁场两个分量的矢量和总是指向磁北,地磁传感器中的导航角θ1就是当前所指的方向和磁北X的夹角,即:
θ1=a tan 2(Hy,Hx)
其中,Hnorth和Hz分别是Hearth在垂直方向和水平方向的分量,Hx和Hy是Hnorth在X和Y方向上的分量;atan2函数是返回方向角的函数,θ1取值范围是[-PI,PI],θ1的取值不仅取决于正切值Hy/Hx,还取决于坐标(Hy,Hx)属于哪个象限:
当坐标(Hy,Hx)属于第一象限,0<θ1<PI/2;
当坐标(Hy,Hx)属于第二象限,PI/2<θ1<PI;
当坐标(Hy,Hx)属于第三象限,-PI<θ1<-PI/2;
当坐标(Hy,Hx)属于第四象限,-PI/2<θ1<0;
当Hy=0,Hx>0时,θ1=0;
当Hy=0,Hx<0时,θ1=PI;
当Hy>0,Hx=0时,θ1=PI/2;
当Hy<0,Hx=0时,θ1=-PI/2;
使计算出的地磁传感器中的导航角θ1值为反正切值,需要将反正切值再乘以180/PI,得到反正切角,角度范围为-180°~180°,再将其加180°得到最终的导航角:
angle=atan 2(Hy,Hx)×(180/PI)+180。
进一步地,本发明的该方法中进行避障识别的算法具体为:
在智能车行驶过程中,当超声波传感器检测到有移动物体穿行过道时,将移动目标距智能车的相对距离和其移动速度传回主控模块;
智能车在满足车辆自身制动约束条件、建立避障系统的制动距离Ds:
其中,a1为智能车减速度,d0为最小间距,在采取避障措施的情况下,保证距离移动物体的最小间距,根据安全距离Dd与制动距离Ds建立模型,根据实际超声波模块的检测距离D1来判断是否需要避障。
进一步地,本发明的该方法中需要进行避障时,其算法具体为:
当需要进行避障时,先以智能车当前位置为起点,移动物体出现所映射到智能车路径上的投影点为末端;通过二次规划与牛顿法相结合的方法寻找车辆距离基准线的最近点;假设车辆距离基准线的最近点所在基准线上的弧长为s,车辆与基准线之间的距离为横向偏移量ρ,则车辆当前坐标可用s-ρ坐标系表示;在此坐标中,避障路径由基准线长度△s、当前车辆位置偏移量ρsi已经最终横向偏移量ρfi确定;避障候选路径满足以下方程,则第i条避障候选路径表示为:
其中,Δs=s-sstart为智能车距离基准线的最近点所在基准线上的弧长;send为基准线上候选避障路径的末端对应的弧长;
求解上式中系数a、b、c,避障候选路径上的生成需考虑智能车当前的航向,同时希望路径末端与基准线的前进方向相同,以保证规划出可行路径,确认以下边界条件:
其中,θ为基准线最近点切向角θstart与当前智能车航向θ0之差
由上述算法通过设定合适的横向偏移量△ρ,根据不同的横向偏移量ρfi的值,计算出不同的系数,a、b、c,从而得到多条避障候选路线;
由于考虑到移动物体的移动速度与距离智能车的相对距离,使用一种加权多目标代价函数去确定最佳避障路线;代价函数主要考虑路径安全性,设计函数如下,包括路径安全性代价函数fs和路径偏移代价函数f0:
f(i)=wsfs(i)+w0f0(i)
select=min f(i)
其中,f(i)为路径总代价函数;i为避障候选路径序列号;ws和w0分别为各代价函数的权重系数;select为选择的路径;
选择以下权重系数:ws=0.7,w0=0.10,fs∈(0.4,1]。
进一步地,本发明的该方法的送水服务中控制出水的算法具体为:
由于考虑到智能车出水口压力传感器信号易受到高频信号干扰,采用有限冲击响应IIR低通滤波器抑制干扰后,再采用零极点补偿进行压力检测传感器检测信号补偿;
IIR滤波器用差分方程和系统函数描述,差分方程为:
其中,x为输入信号;y为输出信号;a,b为系数;对应系统函数为:
由于传感器动态特性与其传递函数零极点有关,现对其零极点分析,观察配置有效零极点来对系统动态特性补偿;对于使用的压力传感器,先采用二阶系统传感器模型进行其极点特性求解;
其中,α为新配置极点的实部,β为新配置极点的虚部,T为采样间隔,现去0.6us,Trr为所要求的响应时间,现取5us,ζe为等效阻尼比,现取0.9;由上式求出:Pe1,2=0.69767±i0.00212;
由公式:
其中,Ge(z)为补偿模型,因此最终压力补偿滤波器为:
本发明产生的有益效果是:本发明的多功能乘务服务智能机器车系统及其控制方法,可完成身份证检票,送餐,提供开水等乘务服务需求,且可根据需要灵活添加各种外设来满足需求。车票检测使用身份证检测方法,既可减少乘客取票的繁琐过程,也减少了对智能车体积的占用。同时一体化服务软件中内置了多种功能服务,使乘务服务多元化。乘客使用操作软件选择所需的服务内容,软件将发送数据至云平台服务器,服务器链接管理系统,待准备完成后,智能车系统就可准确服务乘客。使管理更加方便,服务乘客更加快捷。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例的系统整体结构框图;
图2是本发明实施例的软件流程框图;
图3是本发明实施例的软件与多功能智能车交互流程图;
图4是本发明实施例的多功能智能车的整体设计图;
图5是本发明实施例的智能车行驶图;
图6是本发明实施例的磁场向量分析图;
图7是本发明实施例的智能避障图;
图8是本发明实施例的智能避障计算边界条件图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
本发明实施例的多功能乘务服务智能机器车系统,该系统包括智能机器车,设置在智能机器车内的控制模块、身份证识别模块、压力检测模块、磁传感器模块、超声波模块和无线通讯模块,以及云端;其中:
智能机器车,其车身上设置有开水出水系统和送餐系统;
身份证识别模块,用于检测身份证信息,并通过无线通讯模块将身份证信息发送到云端进行身份核实;
压力检测模块,用于检测开水出水系统的水压,通过控制模块接收压力检测模块和云端的数据,并对存储在控制模块中的压力参数值进行调用和比较,进而对开水出水系统进行控制;
磁传感器模块,用于采集电磁信号进行路线寻迹,通过控制模块接收云端发送的位置信息,并读取磁传感器模块采集到的电磁信号后进行寻迹前往服务位置;
超声波模块,用于在智能机器车进行路线寻迹时实时进行障碍物检测,当检测到障碍物信息时,通过控制模块控制智能机器车停止;
控制模块,还用于对开水出水系统和送餐系统的步进电机进行控制,在抵达服务位置后,实现送餐门和开水门的开启和关闭操作,并进行语音识别的人机交互。
如图1所示乘务服务多功能智能车系统内按功能进行划分:包含了主控系统部分,寻迹避障系统,数据检测系统,云端交互系统,检票系统。其中,寻迹避障系统包括服务路径寻迹与避障停车两部分。检测系统涵盖身份证检测单元,磁传感检测单元,压力传感检测单元三部分。检票系统包括语音交互设计与云端数据交互设计两部分。以及一套web端开发的云端交互系统所组成。
如图2所示的系统一个控制周期内的软件工作流程,首先会判断当前系统所处的工作状态,若未选择其他工作模式,系统默认进入检票工作流程,系统先接收由云端传来的新上乘客的位置信息,接下来乘务服务多功能智能车系统通过路径寻迹和避障识别达到目的地,然后进行语音提示身份证检票,检测完后将身份证信息上传云端进行检索核对,核对完成后语音提示检票成功,智能车回到原位。若为服务模式,云端先向乘务服务多功能智能车系统发送服务信息和服务位置,接下来乘务服务多功能智能车系统通过路径寻迹和避障识别达到目的地,驱动电机打开相应服务所需的门并发出语音提示。
检测系统将传感器采集到的系统信息以特定频率发送给主控芯片实现信息的实时反馈,控制系统根据反馈得到的信息进行智能车路径寻迹和避障识别,同时在进行送水操作时会通过压力传感器判断何时出水。人机交互系统通过语音识别技术实现人机交互功能。云端系统中,乘客通过客户端将需求服务信息传递给服务器端,服务器端将检索的车票验证信息传输给智能车系统。MySQL数据库将用户的身份信息及需求服务信息有效储存并与服务器端通信。
如图3所示,本web项目分为车票检测系统以及服务系统。通过系统对智能车系统端接收的身份证检测信息,服务器端根据身份证检测数据进行检索,并将检索信息反馈给智能车系统端。起始登录页面可注册普通账号,进入服务系统进行服务选择。
在客户选择服务完毕后,客户端会将服务数据反馈给服务器端,同时作为历史数据存入数据库。进而将数据传输给智能车系统,控制智能车前往指定位置完成相应服务。
如图4所示的是多功能智能车的整体设计图,智能车整体在结构上可分为三层:最上层为智能车的检测通讯层,智能车的控制系统,检测系统,人机交互系统,通讯系统等弱电系统均位于顶层;中间层为储物层,此层中分布着两个大仓和两个小仓:其中大仓用于储存食物,舱门受一个拉杆系统控制,通过步进电机的运动控制舱门的开闭;小仓用于储存热水,小仓的闸门式舱门受步进电机驱动控制,其仓内底部设置了一个压力传感器,使小仓能够做到压敏出水。同类型的仓室分居智能车两侧,使得智能车两边的乘客都能轻松拿到食物和水。最下层为制动层,智能车的制动系统、储电充电系统和电磁检测系统位于此层,给整智能车提供动力和路径寻迹,支持整智能车的运作。
本发明实施例的多功能乘务服务智能机器车系统的控制方法,包括以下步骤:
步骤1、判断智能车系统当前所处的工作模式,若未选择服务模式,系统默认进入检票模式,执行步骤2;若系统选择服务模式,执行步骤3;
步骤2、检票模式:接收由云端传来的新上乘客的位置信息,智能车通过路径寻迹和避障识别达到目的地,然后进行语音提示身份证检票,检测完后将身份证信息上传云端进行检索核对,核对完成后语音提示检票成功,智能车回到原位;
步骤3、服务模式:乘客通过客户端将需求服务信息传递给云端服务器,云端服务器将检索的车票验证信息传输给智能车系统,云端服务器的数据库将用户的身份信息及需求服务信息有效储存并与云端服务器通信;
步骤4、云端服务器向智能车系统发送服务信息和服务位置,智能车通过路径寻迹和避障识别达到服务位置,并判断服务信息的类型;
步骤5、若为送水服务,则控制步进电机进行出水门的开门操作,并发出语音提示;若为送餐服务,则控制步进电机进行送餐门的开门操作,并发出语音提示;
步骤6、完成服务模式后,智能车回到原位。
如图5所示,该方法中进行路径寻迹的算法具体为:
保持智能车在列车上直线行驶取,使当前智能车行进的导航角与预期相同,保持与过道的左右间隔相等;计算导航角的方法为:
计算地球磁场和导航角之间的关系,将该点的地磁场Hearth分解为两个平行于当地水平面的分量和一个垂直于当地水平面的分量;
如图6所示,在水平方向上磁场两个分量的矢量和总是指向磁北,地磁传感器中的导航角θ1就是当前所指的方向和磁北X的夹角,即:
θ1=a tan 2(Hy,Hx)
其中,Hnorth和Hz分别是Hearth在垂直方向和水平方向的分量,Hx和Hy是Hnorth在X和Y方向上的分量;atan2函数是返回方向角的函数,θ1取值范围是[-PI,PI],θ1的取值不仅取决于正切值Hy/Hx,还取决于坐标(Hy,Hx)属于哪个象限:
当坐标(Hy,Hx)属于第一象限,0<θ1<PI/2;
当坐标(Hy,Hx)属于第二象限,PI/2<θ1<PI;
当坐标(Hy,Hx)属于第三象限,-PI<θ1<-PI/2;
当坐标(Hy,Hx)属于第四象限,-PI/2<θ1<0;
当Hy=0,Hx>0时,θ1=0;
当Hy=0,Hx<0时,θ1=PI;
当Hy>0,Hx=0时,θ1=PI/2;
当Hy<0,Hx=0时,θ1=-PI/2;
使计算出的地磁传感器中的导航角θ1值为反正切值,需要将反正切值再乘以180/PI,得到反正切角,角度范围为-180°~180°,再将其加180°得到最终的导航角:
angle=atan 2(Hy,Hx)×(180/PI)+180。
如图7所示,该方法中进行避障识别的算法具体为:
在智能车行驶过程中,当超声波传感器检测到有移动物体穿行过道时,将移动目标距智能车的相对距离和其移动速度传回主控模块;
智能车在满足车辆自身制动约束条件、建立避障系统的制动距离Ds:
其中,a1为智能车减速度,d0为最小间距,在采取避障措施的情况下,保证距离移动物体的最小间距,根据安全距离Dd与制动距离Ds建立模型,根据实际超声波模块的检测距离D1来判断是否需要避障。
该方法中需要进行避障时,其算法具体为:
当需要进行避障时,先以智能车当前位置为起点,移动物体出现所映射到智能车路径上的投影点为末端;通过二次规划与牛顿法相结合的方法寻找车辆距离基准线的最近点;假设车辆距离基准线的最近点所在基准线上的弧长为s,车辆与基准线之间的距离为横向偏移量ρ,则车辆当前坐标可用s-ρ坐标系表示;在此坐标中,避障路径由基准线长度△s、当前车辆位置偏移量ρsi已经最终横向偏移量ρfi确定;避障候选路径满足以下方程,则第i条避障候选路径表示为:
其中,Δs=s-sstart为智能车距离基准线的最近点所在基准线上的弧长;send为基准线上候选避障路径的末端对应的弧长;
求解上式中系数a、b、c,避障候选路径上的生成需考虑智能车当前的航向,同时希望路径末端与基准线的前进方向相同,以保证规划出可行路径,确认以下边界条件:
其中,θ为基准线最近点切向角θstart与当前智能车航向θ0之差
如图8所示,由上述算法通过设定合适的横向偏移量△ρ,根据不同的横向偏移量ρfi的值,计算出不同的系数,a、b、c,从而得到多条避障候选路线;
由于考虑到移动物体的移动速度与距离智能车的相对距离,使用一种加权多目标代价函数去确定最佳避障路线;代价函数主要考虑路径安全性,设计函数如下,包括路径安全性代价函数fs和路径偏移代价函数f0:
f(i)=wsfs(i)+w0f0(i)
select=min f(i)
其中,f(i)为路径总代价函数;i为避障候选路径序列号;ws和w0分别为各代价函数的权重系数;select为选择的路径;
选择以下权重系数:ws=0.7,w0=0.10,fs∈(0.4,1]。
该方法的送水服务中控制出水的算法具体为:
由于考虑到智能车出水口压力传感器信号易受到高频信号干扰,采用有限冲击响应IIR低通滤波器抑制干扰后,再采用零极点补偿进行压力检测传感器检测信号补偿;
IIR滤波器用差分方程和系统函数描述,差分方程为:
其中,x为输入信号;y为输出信号;a,b为系数;对应系统函数为:
由于传感器动态特性与其传递函数零极点有关,现对其零极点分析,观察配置有效零极点来对系统动态特性补偿;对于使用的压力传感器,先采用二阶系统传感器模型进行其极点特性求解;
其中,α为新配置极点的实部,β为新配置极点的虚部,T为采样间隔,现去0.6us,Trr为所要求的响应时间,现取5us,ζe为等效阻尼比,现取0.9;由上式求出:Pe1,2=0.69767±i0.00212;
由公式:
其中,Ge(z)为补偿模型,因此最终压力补偿滤波器为:
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (10)
1.一种多功能乘务服务智能机器车系统,其特征在于,该系统包括智能机器车,设置在智能机器车内的控制模块、身份证识别模块、压力检测模块、磁传感器模块、超声波模块和无线通讯模块,以及云端;其中:
智能机器车,其车身上设置有开水出水系统和送餐系统;
身份证识别模块,用于检测身份证信息,并通过无线通讯模块将身份证信息发送到云端进行身份核实;
压力检测模块,用于检测开水出水系统的水压,通过控制模块接收压力检测模块和云端的数据,并对存储在控制模块中的压力参数值进行调用和比较,进而对开水出水系统进行控制;
磁传感器模块,用于采集电磁信号进行路线寻迹,通过控制模块接收云端发送的位置信息,并读取磁传感器模块采集到的电磁信号后进行寻迹前往服务位置;
超声波模块,用于在智能机器车进行路线寻迹时实时进行障碍物检测,当检测到障碍物信息时,通过控制模块控制智能机器车停止;
控制模块,还用于对开水出水系统和送餐系统的步进电机进行控制,在抵达服务位置后,实现送餐门和开水门的开启和关闭操作,并进行语音识别的人机交互。
2.根据权利要求1所述的多功能乘务服务智能机器车系统,其特征在于,所述控制模块采用STM32F407ZGT6核心控制模块。
3.根据权利要求1所述的多功能乘务服务智能机器车系统,其特征在于,所述控制模块在一个控制周期内对接收信息和寻迹路线行进规划的调控过程中,首先初始化控制模块内部所存储的地点位置变量的设定值,这些设定值被保存在其内部的一块特定的RAM区域中,其后从云端收到地点数据并进行数据解码,解码后从RAM中调取初始位置变量的设定值与当前值进行比较,计算出偏差值,利用该偏差值计算出系统执行器的所需的前进距离,最后根据距离寻迹前往相应地点。
4.根据权利要求1所述的多功能乘务服务智能机器车系统,其特征在于,所述云端的服务器在列车出站后,将下车人数和上车人数的数据存入数据库中,并向控制模块发送需要检票的位置信息,智能车根据位置信息前往指定位置进行身份证检票。
5.根据权利要求1所述的多功能乘务服务智能机器车系统,其特征在于,该系统还包括乘客客户端,乘客在客户端中选择自己需要的相应服务内容,服务数据将传输给云端的服务器存入数据库中,并将服务信息和服务位置数据传输给智能车系统,智能车采用磁传感的方法进行寻迹,超声波检测进行避障处理,在抵达指定位置后,智能车系统控制不同部件实现不同的服务内容。
6.一种多功能乘务服务智能机器车系统的控制方法,其特征在于,包括以下步骤:
步骤1、判断智能车系统当前所处的工作模式,若未选择服务模式,系统默认进入检票模式,执行步骤2;若系统选择服务模式,执行步骤3;
步骤2、检票模式:接收由云端传来的新上乘客的位置信息,智能车通过路径寻迹和避障识别达到目的地,然后进行语音提示身份证检票,检测完后将身份证信息上传云端进行检索核对,核对完成后语音提示检票成功,智能车回到原位;
步骤3、服务模式:乘客通过客户端将需求服务信息传递给云端服务器,云端服务器将检索的车票验证信息传输给智能车系统,云端服务器的数据库将用户的身份信息及需求服务信息有效储存并与云端服务器通信;
步骤4、云端服务器向智能车系统发送服务信息和服务位置,智能车通过路径寻迹和避障识别达到服务位置,并判断服务信息的类型;
步骤5、若为送水服务,则控制步进电机进行出水门的开门操作,并发出语音提示;若为送餐服务,则控制步进电机进行送餐门的开门操作,并发出语音提示;
步骤6、完成服务模式后,智能车回到原位。
7.根据权利要求6所述的多功能乘务服务智能机器车系统的控制方法,其特征在于,该方法中进行路径寻迹的算法具体为:
保持智能车在列车上直线行驶取,使当前智能车行进的导航角与预期相同,保持与过道的左右间隔相等;计算导航角的方法为:
计算地球磁场和导航角之间的关系,将该点的地磁场Hearth分解为两个平行于当地水平面的分量和一个垂直于当地水平面的分量;
在水平方向上磁场两个分量的矢量和总是指向磁北,地磁传感器中的导航角θ1就是当前所指的方向和磁北X的夹角,即:
θ1=a tan 2(Hy,Hx)
其中,Hnorth和Hz分别是Hearth在垂直方向和水平方向的分量,Hx和Hy是Hnorth在X和Y方向上的分量;atan2函数是返回方向角的函数,θ1取值范围是[-PI,PI],θ1的取值不仅取决于正切值Hy/Hx,还取决于坐标(Hy,Hx)属于哪个象限:
当坐标(Hy,Hx)属于第一象限,0<θ1<PI/2;
当坐标(Hy,Hx)属于第二象限,PI/2<θ1<PI;
当坐标(Hy,Hx)属于第三象限,-PI<θ1<-PI/2;
当坐标(Hy,Hx)属于第四象限,-PI/2<θ1<0;
当Hy=0,Hx>0时,θ1=0;
当Hy=0,Hx<0时,θ1=PI;
当Hy>0,Hx=0时,θ1=PI/2;
当Hy<0,Hx=0时,θ1=-PI/2;
使计算出的地磁传感器中的导航角θ1值为反正切值,需要将反正切值再乘以180/PI,得到反正切角,角度范围为-180°~180°,再将其加180°得到最终的导航角:
angle=atan 2(Hy,Hx)×(180/PI)+180。
9.根据权利要求8所述的多功能乘务服务智能机器车系统的控制方法,其特征在于,该方法中需要进行避障时,其算法具体为:
当需要进行避障时,先以智能车当前位置为起点,移动物体出现所映射到智能车路径上的投影点为末端;通过二次规划与牛顿法相结合的方法寻找车辆距离基准线的最近点;假设车辆距离基准线的最近点所在基准线上的弧长为s,车辆与基准线之间的距离为横向偏移量ρ,则车辆当前坐标可用s-ρ坐标系表示;在此坐标中,避障路径由基准线长度△s、当前车辆位置偏移量ρsi已经最终横向偏移量ρfi确定;避障候选路径满足以下方程,则第i条避障候选路径表示为:
其中,Δs=s-sstart为智能车距离基准线的最近点所在基准线上的弧长;send为基准线上候选避障路径的末端对应的弧长;
求解上式中系数a、b、c,避障候选路径上的生成需考虑智能车当前的航向,同时希望路径末端与基准线的前进方向相同,以保证规划出可行路径,确认以下边界条件:
其中,θ为基准线最近点切向角θstart与当前智能车航向θ0之差
由上述算法通过设定合适的横向偏移量△ρ,根据不同的横向偏移量ρfi的值,计算出不同的系数,a、b、c,从而得到多条避障候选路线;
由于考虑到移动物体的移动速度与距离智能车的相对距离,使用一种加权多目标代价函数去确定最佳避障路线;代价函数主要考虑路径安全性,设计函数如下,包括路径安全性代价函数fs和路径偏移代价函数f0:
f(i)=wsfs(i)+w0f0(i)
select=min f(i)
其中,f(i)为路径总代价函数;i为避障候选路径序列号;ws和w0分别为各代价函数的权重系数;select为选择的路径;
选择以下权重系数:ws=0.7,w0=0.10,fs∈(0.4,1]。
10.根据权利要求6所述的多功能乘务服务智能机器车系统的控制方法,其特征在于,该方法的送水服务中控制出水的算法具体为:
由于考虑到智能车出水口压力传感器信号易受到高频信号干扰,采用有限冲击响应IIR低通滤波器抑制干扰后,再采用零极点补偿进行压力检测传感器检测信号补偿;
IIR滤波器用差分方程和系统函数描述,差分方程为:
其中,x为输入信号;y为输出信号;a,b为系数;对应系统函数为:
由于传感器动态特性与其传递函数零极点有关,现对其零极点分析,观察配置有效零极点来对系统动态特性补偿;对于使用的压力传感器,先采用二阶系统传感器模型进行其极点特性求解;
其中,α为新配置极点的实部,β为新配置极点的虚部,T为采样间隔,现去0.6us,Trr为所要求的响应时间,现取5us,ζe为等效阻尼比,现取0.9;由上式求出:Pe1,2=0.69767±i0.00212;
由公式:
其中,Ge(z)为补偿模型,因此最终压力补偿滤波器为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011290129.2A CN112269389B (zh) | 2020-11-18 | 2020-11-18 | 一种多功能乘务服务智能机器车系统及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011290129.2A CN112269389B (zh) | 2020-11-18 | 2020-11-18 | 一种多功能乘务服务智能机器车系统及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112269389A true CN112269389A (zh) | 2021-01-26 |
CN112269389B CN112269389B (zh) | 2023-05-02 |
Family
ID=74340219
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011290129.2A Active CN112269389B (zh) | 2020-11-18 | 2020-11-18 | 一种多功能乘务服务智能机器车系统及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112269389B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113655789A (zh) * | 2021-08-04 | 2021-11-16 | 东风柳州汽车有限公司 | 路径跟踪方法、装置、车辆及存储介质 |
CN117406731A (zh) * | 2023-10-24 | 2024-01-16 | 东莞东晟装备科技有限公司 | 无人移动靶车协同编队控制方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102811190A (zh) * | 2011-05-31 | 2012-12-05 | 上海明波通信技术股份有限公司 | Ofdm通信系统中单频干扰的抑制方法 |
CN204950558U (zh) * | 2015-07-21 | 2016-01-13 | 中国铁道科学研究院电子计算技术研究所 | 一种现代车站的智能运输开水机器人 |
CN210175020U (zh) * | 2019-06-14 | 2020-03-24 | 神华铁路货车运输有限责任公司 | 列车配件运载agv及系统 |
CN111489023A (zh) * | 2020-04-03 | 2020-08-04 | 武汉理工大学 | 一种处理动态乘务服务需求信息的多功能智能机器人系统 |
KR20200127835A (ko) * | 2019-04-30 | 2020-11-11 | 엘지전자 주식회사 | 존 기반 모빌리티 서비스 추천 및 동적 하차위치 설정 ui/ux를 이용한 통합 관제 시스템 및 이의 제어 방법 |
-
2020
- 2020-11-18 CN CN202011290129.2A patent/CN112269389B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102811190A (zh) * | 2011-05-31 | 2012-12-05 | 上海明波通信技术股份有限公司 | Ofdm通信系统中单频干扰的抑制方法 |
CN204950558U (zh) * | 2015-07-21 | 2016-01-13 | 中国铁道科学研究院电子计算技术研究所 | 一种现代车站的智能运输开水机器人 |
KR20200127835A (ko) * | 2019-04-30 | 2020-11-11 | 엘지전자 주식회사 | 존 기반 모빌리티 서비스 추천 및 동적 하차위치 설정 ui/ux를 이용한 통합 관제 시스템 및 이의 제어 방법 |
CN210175020U (zh) * | 2019-06-14 | 2020-03-24 | 神华铁路货车运输有限责任公司 | 列车配件运载agv及系统 |
CN111489023A (zh) * | 2020-04-03 | 2020-08-04 | 武汉理工大学 | 一种处理动态乘务服务需求信息的多功能智能机器人系统 |
Non-Patent Citations (4)
Title |
---|
张洪润: "《传感器应用设计300例:上》", 31 October 2008 * |
彭晓燕; 谢浩; 黄晶: "无人驾驶汽车局部路径规划算法研究", 《汽车工程》 * |
杨文杰; 张志杰; 王代华; 陈青青: "压力传感器动态误差修正方法的FPGA实现", 《传感技术学报》 * |
许鸿文,殷蔚明,罗林波: "《机器人完全DIY 从零起步》", 31 August 2015 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113655789A (zh) * | 2021-08-04 | 2021-11-16 | 东风柳州汽车有限公司 | 路径跟踪方法、装置、车辆及存储介质 |
WO2023010854A1 (zh) * | 2021-08-04 | 2023-02-09 | 东风柳州汽车有限公司 | 路径跟踪方法、装置、车辆及存储介质 |
CN117406731A (zh) * | 2023-10-24 | 2024-01-16 | 东莞东晟装备科技有限公司 | 无人移动靶车协同编队控制方法及系统 |
CN117406731B (zh) * | 2023-10-24 | 2024-05-24 | 东莞东晟装备科技有限公司 | 无人移动靶车协同编队控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112269389B (zh) | 2023-05-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105702083B (zh) | 基于分布式视觉的停车场-车辆协同智能停车系统及方法 | |
CN105679068B (zh) | 一种与智能停车场协同的智能车辆自动驾驶系统和方法 | |
CN106952496B (zh) | 无人驾驶汽车智能寻车位方法 | |
CN109403690A (zh) | 自动车辆搬运与转移的方法、系统及应用 | |
CN1326735C (zh) | 自动列车运行装置以及列车运行辅助装置 | |
CN106781688B (zh) | 无人驾驶汽车停车场入口引导系统及方法 | |
CN103863364B (zh) | 一种基于调度信号的货运机车自动操纵实时优化控制系统 | |
CN110371112A (zh) | 一种自动驾驶车辆的智能避障系统及方法 | |
CN109559501A (zh) | 一种无人驾驶出租车系统及其控制方法 | |
CN107633694A (zh) | 一种无人驾驶汽车的停车管理系统 | |
CN101372235B (zh) | 列车定位停止自动控制装置 | |
CN107329466A (zh) | 一种自动驾驶小型车 | |
CN107209518A (zh) | 代客泊车方法和代客泊车系统 | |
CN104298236A (zh) | 智能公交系统的行程规划和管理方法 | |
CN104183153A (zh) | 基于四旋翼无人机做引导的智能停车引导系统 | |
CN112269389A (zh) | 一种多功能乘务服务智能机器车系统及其控制方法 | |
CN110136426A (zh) | 一种还车招车系统及方法 | |
CN108535685A (zh) | 移动体控制系统 | |
CN108680180A (zh) | 路况信息车辆导航系统及其导航方法 | |
CN109895794A (zh) | 基于机器学习的列车自动驾驶系统精准停车方法及装置 | |
CN106846892A (zh) | 基于机器视觉的停车场‑车辆协同智能停车系统及方法 | |
EP4207134A1 (en) | Parking control method and related device | |
CN110888458B (zh) | 无人机飞行控制方法、无人机、系统及存储介质 | |
CN106778857A (zh) | 到港航班行李状态自动获取的方法 | |
CN109709944A (zh) | 一种自动驾驶公交车的进站方法及其进站路径的生成方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |