CN113721623A - 基于5g技术的自动驾驶轮椅 - Google Patents
基于5g技术的自动驾驶轮椅 Download PDFInfo
- Publication number
- CN113721623A CN113721623A CN202111012715.5A CN202111012715A CN113721623A CN 113721623 A CN113721623 A CN 113721623A CN 202111012715 A CN202111012715 A CN 202111012715A CN 113721623 A CN113721623 A CN 113721623A
- Authority
- CN
- China
- Prior art keywords
- module
- steering
- microprocessor
- driving
- path
- 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.)
- Withdrawn
Links
- 238000005516 engineering process Methods 0.000 title claims abstract description 31
- 230000007246 mechanism Effects 0.000 claims abstract description 29
- 238000000034 method Methods 0.000 claims description 15
- 230000003068 static effect Effects 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 6
- 230000003993 interaction Effects 0.000 claims description 4
- 238000013519 translation Methods 0.000 claims description 4
- 238000007476 Maximum Likelihood Methods 0.000 claims description 3
- 230000005236 sound signal Effects 0.000 claims description 3
- 230000001360 synchronised effect Effects 0.000 claims description 3
- 230000003321 amplification Effects 0.000 claims 1
- 238000003199 nucleic acid amplification method Methods 0.000 claims 1
- 238000013178 mathematical model Methods 0.000 abstract description 2
- 230000003044 adaptive effect Effects 0.000 description 9
- 230000004888 barrier function Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000005484 gravity Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 230000002093 peripheral effect Effects 0.000 description 4
- 238000013139 quantization Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- 238000010295 mobile communication Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- FGUUSXIOTUKUDN-IBGZPJMESA-N C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 Chemical compound C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 FGUUSXIOTUKUDN-IBGZPJMESA-N 0.000 description 1
- 230000002776 aggregation Effects 0.000 description 1
- 238000004220 aggregation Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 239000007787 solid Substances 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Abstract
本发明揭示了一种基于5G技术的自动驾驶轮椅，包括行进执行机构、转向执行机构、以及自动驾驶控制组件；自动驾驶控制组件包括定位导航模块、避障控制模块、CAN总线模块和路径跟踪控制模块，定位导航模块输出最优导航路径，避障控制模块输出最优避障路径，路径跟踪控制模块输出期望转角，CAN总线模块将其他各个模块连接起来形成一个分布式控制结构。本发明的基于5G技术的自动驾驶轮椅具有定位、导航、避障和路径跟踪，可对行进执行机构和转向执行机构进行控制，实现可控式行进和转向，达到自动驾驶的目的，并且系统结构稳定可靠，不依赖精确数学模型，具有较好的鲁棒性。
Description
本申请是以下专利申请的分案申请：
发明创造名称：基于5G技术的轮椅自动驾驶控制方法及自动驾驶轮椅
申请日：2020-10-27
申请号：2020111755706
技术领域
本发明的实施例涉及一种轮椅，具体而言，涉及基于5G技术的自动驾驶轮椅。
背景技术
第五代移动通信技术(简称5G或5G技术)是最新一代蜂窝移动通信技术，也是继4G(LTE-A、WiMax)、3G(UMTS、LTE)和2G(GSM)系统之后的延伸。5G技术的性能目标是高数据速率、减少延迟、节省能源、降低成本、提高系统容量和大规模设备连接。ITU IMT-2020规范要求速度高达20Gbit/s，可以实现宽信道带宽和大容量MIMO。
5G技术的其中一个重要应用领域为车联网，车联网技术经历了利用有线通信的路侧单元(道路提示牌)以及2G/3G/4G网络承载车载信息服务的阶段，正在依托高速移动的通信技术，逐步步入自动驾驶时代。根据中国、美国、日本等国家的汽车发展规划，依托传输速率更高、时延更低的5G网络，将在2025年全面实现自动驾驶汽车的量产。
然而，谈及自动驾驶技术，公众想到最多的应该是汽车，但是如果将5G技术和自动驾驶技术应用到轮椅中，使得提升现有轮椅的智能性，对肢体伤残者和行动不便人士或许能提供更大的帮助。
发明内容
本发明的目的在于针对现有技术中的上述缺陷，提供一种基于5G技术的自动驾驶轮椅。
为实现上述发明目的，本发明采用了如下技术方案：一种基于5G技术的自动驾驶轮椅，包括行进执行机构、转向执行机构、以及自动驾驶控制组件；自动驾驶控制组件包括：定位导航模块、避障控制模块、CAN总线模块和路径跟踪控制模块，其中，定位导航模块通过CAN总线模块与路径跟踪控制模块耦接，并用于获取位置信息、姿态方位角和地图信息，并执行蚂蚁算法输出最优导航路径；避障控制模块通过CAN总线模块与路径跟踪控制模块耦接，并用于检测行进路径前方的动态障碍物和静态障碍物，并执行人工势场法输出最优避障路径；路径跟踪控制模块包括自适应模糊PID控制器，其接收当前位置坐标、当前姿态方位角、最优导航路径以及最优避障路径，并通过模糊自适应PID算法计算输出期望转角，并通过串口传送给转向执行机构。
本发明的基于5G技术的自动驾驶轮椅的优势在于具有自动驾驶控制组件，该自动驾驶控制组件设计有定位导航模块、避障控制模块、CAN总线模块和路径跟踪控制模块，定位导航模块输出最优导航路径，避障控制模块输出最优避障路径，路径跟踪控制模块输出期望转角，CAN总线模块将其他各个模块连接起来形成一个分布式控制结构。本发明的基于5G技术的自动驾驶轮椅具有定位、导航、避障和路径跟踪，可对行进执行机构和转向执行机构进行控制，实现可控式行进和转向，达到自动驾驶的目的，并且系统结构稳定可靠，不依赖精确数学模型，具有较好的鲁棒性。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例或相关技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅涉及本发明的一些实施例，并非对本发明的限制。
图1是基于5G技术的自动驾驶轮椅的系统框图。
图2是四个5G微基站的安装示意图。
图3是CAN总线模块的电路图。
图4是语音交互模块的电路图。
图5是转向同步组件的结构示意图。
图6是转向驱动组件其中一个实施例的结构示意图。
图7是转向驱动组件另一个实施例的结构示意图。
图8是行进执行机构的结构示意图。
图9是差速器的结构示意图。
图10是轮椅自动驾驶控制方法的系统框图。
图11是轮椅自动驾驶控制方法的流程图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点，下面结合附图和具体实施方式对本发明技术方案作进一步非限制性的详细描述。
由于轮椅的使用场景有一定限制性，而且行驶路径和路面情况也比较简单，本实施例的轮椅主要使用场景在医院，基于以上特点，本实施例针对轮椅的自动驾驶做出详细描述。
本实施例公开一种基于5G技术的自动驾驶轮椅，见图1，其主要包括：行进执行机构6、转向执行机构7和自动驾驶控制组件。自动驾驶控制组件又主要包括定位导航模块1、避障控制模块2、路径跟踪控制模块3、CAN总线模块4和人机交互模块5。
定位导航模块1用于获取其当前位置信息、姿态方位角和地图信息，并通过执行蚂蚁算法输出最优导航路径。定位导航模块1包括安装在轮椅本体上的卫星导航接收器10、5G模组11、第一微处理器12和电子罗盘13，以及分散安装在室内的至少四个5G微基站。
卫星导航接收器10采用的是S1216F8-BD型号的双模卫星导航接收器(北斗、GPS)，该接收器通过串口与第一微处理器12耦接，第一微处理器12采用的是STM32型单片机。卫星导航接收器10与导航卫星通信，在接收到卫星信号后将所接收到的卫星信号处理成字段头为$GPRMC的NMEA0183标准格式报文，并通过串口发送给第一微处理器12。
5G模组11采用华为公司的5G车载模组MH5000，其通过串口与第一微处理器12耦接。5G模组11通过5G网络接入移动互联网，访问地图数据库并实时下载地图信息，地图信息包括卫星地图信息和室内地图信息，并通过串口发送给第一微处理器12。
本实施例选用四个5G微基站，分别是第一基站14a、第二基站14b、第三基站14c和第四基站14d。见图2，第一基站14a安装在电梯出入口处，第二基站14b、第三基站14c和第四基站14d分散安装在同一楼层内，该四个5G微基站可分别基于5G通信协议与5G模组进行无线通信，并分别向5G模组发送室内位置信息，室内位置信息内容包含：楼栋编号、楼层编号、伪距信号和位置坐标信号；5G模组11将室内地图信息和室内位置信息转送给第一微处理器12，第一微处理器12可基于RSSI极大似然估计定位算法计算出室内位置坐标。
第一微处理器12将卫星导航接收器10报文分割成以导航语句为基本单元的多个片段，然后在相应的数据域的对应字段中提取导航的定位参数，并对一部分数据进行数据转换，完成导航数据的解析，并通过执行蚂蚁算法输出最优导航路径。另外，第一微处理器12基于其计算出的室内位置坐标，同样通过执行蚂蚁算法输出最优导航路径。
电子罗盘13采用LP3200-232EAB-D50型号高精度平面电子罗盘，计算轮椅本体当前的姿态方位角，即罗盘指北轴线在水平面的投影和地磁北线在地面投影的夹角，然后通过RS232接口发送给第一微处理器12，在由第一微处理12打包处理后经CAN总线模块4发送给路径跟踪控制模块3
避障控制模块用于检测行进路径前方的动态障碍物和静态障碍物，并执行人工势场法输出最优避障路径。动态障碍物主要是行人，静态障碍物主要是临时摆放的固体物质(比如仪器设备，箱体等)，基于轮椅的使用场景分析，在行进路径上遇到动态障碍物的概率较大。避障控制模块包括第二微处理器20、激光雷达传感器21和人体红外传感器22，其中的激光雷达传感器21安装在轮椅本体的前端并位于左扶手下方，人体红外传感器22安装在轮椅本体的前端并位于右扶手的下方，激光雷达传感器21和人体红外传感器22均与第二微处理器20耦接。本实施例，激光雷达传感器21采用为德国西克(SICK)牌的LMS111激光扫描雷达，通过串口向第二微处理20实时传输数据，用于障碍物测量和防撞。本实施例，人体红外传感器22采用型号为HC-SR501的人体红外感应模块，通过串口向第二微处理20实时传输数据，用于探测人体辐射。本实施例，第二微处理器20同样采用STM32型单片机，接收激光雷达传感器21和人体红外传感器22的数据，并首先判断障碍物类型，然后依据人工势场法计算输出最优避障路径。第二微处理器20通过CAN总线模块3与路径跟踪控制模块3耦接，将最优避障路径的数据发送给路径跟踪控制模块3。
路径跟踪控制模块3包括第三微处理30和角度传感器31，第三微处理器30内置有自适应模糊PID控制器，自适应模糊PID控制器主要由模糊控制器321、PID控制器322和限幅器323组成。第三微处理器30通过CAN总线模块3接收到当前位置坐标(室外位置坐标或室内位置坐标)、当前姿态方位角、最优导航路径和最优避障路径，并将当前位置坐标与最优导航路径或最优避障路径进行比对计算得到横向偏差，将当前姿态方位角与最优导航路径或最优避障路径进行对比计算得到航向角偏差，两个偏差值被输入到自适应模糊PID控制器中执行模糊自适应PID算法计算输出期望转角，期望转角通过串口传送给转向执行机构。期望转角实为脉冲信号。
角度传感器31用于实时采集所述转向执行机构转动的转角值，其采用北京通磁伟业公司的WYT-AT-3-360无触点角度传感器，为电流输出型传感器，其电流信号经电流环接收芯片RCV420转换成电压信号，再经过OP07放大电路将电压按比例转换成0～3.3V后送入第三微处理器30，最终传送给自适应模糊PID控制器，作为PID控制反馈。
见图3，CAN总线模块4包括CAN-BUS和若干个外接的监控节点，每个监控节点都包括PHILIP公司的TJA1050TCAN总线驱动芯片U5和外围抗干扰电路。外围抗干扰电路包括耦接在总线驱动芯片U5的RXD端的第一光耦U6，以及耦接在总线驱动芯片U5的TXD端的第二光耦U4，第一光耦U6和该第二光耦U4的VA、VB通过DC-DC模块或者带有多个隔离输出的开关电源进行隔离。CAN总线模块3是基于ISO11783标准的CAN总线技术，通过CAN总线连接各个网络节点，形成多主机控制器局域网。
人机交互模块与第一微处理12耦接，其包括语音识别模块和触摸屏模块，语音识别模块主要用于语音输入终点，触摸屏模块主要用于手动输入终点和显示行驶路径。其中，见图4，语音识别模块包括话筒MK1、语音放大电路(LM386型芯片U1及其外围电路)和音频信号调制器(LM567型芯片U2及其外围电路)，音频信号调制器的输出端耦接第一微处理器12。
转向执行机构包括两个转向轮(前轮)、转向同步组件和转向驱动组件。见图5，转向同步组件包括固定杆60、平动杆61、第一连接件62、第二连接件63、第一连杆64、第二连杆65和固定架66。固定杆60和固定架66固定配接，呈长方形桁架结构，而该桁架结构与轮椅本体固定连接，用于将整个转向执行机构固定安装在轮椅本体下方前端。第一连接件62和第二连接件63的截面大致呈“匚”形，并分别铰接在固定杆60的两端，其外侧分别通过转轴和轴承与两个转向轮50、51一对一配接。在第一连接件62上设置有第一支杆67和第二支杆68，在第二连接件63上设置有第三支杆69，第一支杆67和第三支杆69分别与平动杆61的两端铰接，第二支杆68与第一连杆64的其中一端铰接，第一连杆64的另一端与第二连杆65的其中一端铰接，第二连杆65的另一端则与转向驱动组件配接。见图6，转向驱动组件包括驱动电机70、主动轮71、从动轮72和输出轴73。驱动电机70为直流步进电机，其与第三微处理30耦接，用于接收自适应模糊PID控制器输出的期望转角(脉冲信号)，由期望转角控制其角位移(即角度)。驱动电机70通过其电机轴与主动轮71相固定配接，主动轮71又与从动轮72相啮合，而从动轮72与输出轴73的其中一端相固定配接，输出轴73的另一端与第二连杆65相固定配接。
本实施例的转向执行机构的执行过程为：驱动电机70-主动轮71-从动轮72-输出轴73-第二连杆65-第一连杆64-第一连接件62-平动杆61-第二连接件63，通过齿轮和连杆结构，实现了转向驱动和转向同步。
见图7，为了提供手动控制转向的应急功能，还提供另一实施例的转向驱动组件。转向驱动组件包括驱动电机70、主动轮71、从动轮72、输出轴73、拉杆74、转向杆75、手动转向齿轮76和套环77。驱动电机70为直流步进电机，其与第三微处理30耦接，用于接收自适应模糊PID控制器输出的期望转角(脉冲信号)，由期望转角控制其角位移(即角度)。驱动电机70通过其电机轴与主动轮71相固定配接，主动轮71又与从动轮72相啮合，而从动轮72可滑动地套装在输出轴73的上端部，输出轴73的下端部与第二连杆65相固定配接。手动转向齿轮76套接在转向杆75的下端部，并且位于从动轮72的上方，可以与从动轮72选择性啮合，即，从动轮72可沿输出轴73滑动地切换与手动转向齿轮76啮合。在从动轮72上方设置有环槽部78，套环77可旋转地套设在环槽部78外，拉杆8的下端固定连接在套环77上。当需要调节为手动转向时，拉动拉杆74，从动轮72上升并与手动转向齿轮76啮合，转动转向杆75即可实现手动控制转向。
本实施例的转向执行机构的增加了手动转向功能，其与电动转向的不同之处仅在于：动力由转向杆75输入，并经手动转向齿轮76带动从动轮72，从而带动输出轴73。本实施例的手动控制转向仅为应急措施。
见图8，行进执行机构包括两个行进驱动轮80a、80b(后轮)、行进驱动电机81和差速器82。行进驱动电机81为直流伺服电机，其与第二微处理20耦接，受第二微处理20逻辑控制其转速和转矩。见图9，差速器包括壳体，以及设置在壳体内的主动锥齿轮821、从动锥齿轮822、行星轮架823、两个行星轮824和两个太阳轮825。两个行星轮824相互对称设置，并分别通过轴承连接在行星轮架823内；两个太阳轮825相互对称设置，并分别与两个行星轮824相啮合，两个行进驱动轮80a、80b分别通过左轮轴826和右轮轴827与两个太阳轮825一对一相固定配接；从动锥齿轮822固定套接在其中一根轮轴(本实施例是左轮轴826)上；主动锥齿轮821与行进驱动电机81的电机轴相配接，并且与从动锥齿轮822相啮合。
本实施例的行进执行机构通过设计差速器实现一个电机控制行进，同时实现平稳转向。
见图10和图11，本实施例还提供一种基于5G技术的轮椅自动驾驶控制方法，该控制方法与上述的“基于5G技术的自动驾驶轮椅”相适应，具体地，其包括如下步骤：
1)定位控制，包括：室外定位和室内定位，
1.1)室外定位的方法为：卫星导航接收器与导航卫星通信，通过卫星定位获取轮椅当前位置坐标。5G模组通过5G网络接入移动互联网并获取室外地图信息，该室外地图信息可通过触摸屏模块进行实时显示，显示界面为地图2D界面，具体可调用高德地图或百度地图接口，当前位置坐标在地图2D界面实时显示。电子罗盘进行方向定位、并获取轮椅姿态方位角。
1.2)室内定位的方法为：
a)在室内布设4个5G微基站，其中一个5G微基站安装在电梯出入口处，其余三个5G微基站分散安装在室内。如果室内面积较大，隔间较多，可以适当增加5G微基站数量。当轮椅进入5G微基站的覆盖区域内时，5G模组与5G微基站进行无线通信，所有5G微基站都可以向5G模组发送位置识别信号，位置识别信号内容包含：楼栋编号、楼层编号、伪距信号和位置坐标信号。伪距信号指的是：向5G模组发送信号的5G微基站与5G模组之间的大概距离。位置坐标信指的是：5G微基站其本身固定的位置坐标。
b)由于目前的轮椅不具备爬梯功能，因此目前所有的轮椅想要上楼必须依靠电梯，因此可以设定逻辑判断：5G模组根据接收到的位置识别信号中的伪距信号选择距离最近的5G微基站判定为电梯出入口处的5G微基站，根据该电梯出入口处的5G微基站发出的位置识别信号中的楼栋编号和楼层编号确定当前所在楼栋和楼层。
c)5G模组接收并保存多个5G微基站的位置识别信号，并根据楼栋编号和楼层编号，选择含有相同楼栋编号和楼层编号的位置识别信号为有用信号，其余信号进行丢包。根据被选择的三个5G微基站的位置识别信号中的伪距信号和位置坐标信号，第一微处理器基于RSSI极大似然估计定位算法中的三角定位算法计算出5G模组的位置坐标，即，轮椅的当前位置坐标。三角定位算法为，假设三个5G基站到5G模组的距离分别为R1，R2，R3，则以三个基站坐标为圆心，以三个基站到5G模组的距离为半径可以画出三个相交的圆，5G模组的位置坐标即为三圆相交点。
但是，在实际测量中，往往由于测量的误差，使三个圆并不交于一点，而相交于一块区域，可以再采用最小二乘法进行优化求解。
假设三个5G微基站的位置坐标分别为(X1，Y1)，(X2，Y2)，(X2，Y2)，5G模组的位置坐标为(X，Y)。三个5G微基站与5G模组的距离分别为d1、d2、d3。
建立以下方程组：
用上述的前n-1个方程依次减去第n个方程，可以得到如下的矩阵表示形式：
AX＝Y；
其中：
采用最小二乘求解，可以得到X＝(AT A)-1ATY，X便是5G模组的坐标计算值。
d)5G模组通过5G网络接入移动互联网并获取室内地图信息，该室内地图信息可通过触摸屏模块进行实时显示，显示界面为地图2D界面。室内地图信息为预先上传至云数据库的地图数据，5G模组访问云数据库读取室内地图信息，并根据位置识别信号中的楼栋编号和楼层编号下载相应的室内地图信息。
e)电子罗盘进行方向定位、并获取轮椅姿态方位角。
2)路径导航控制，包括：
2.1)通过语音识别模块或触摸屏模块输入目的地，该目的地应该是选择项，即，只能选取系统内存储的目的地。
2.2)将步骤1)确定的轮椅当前位置信息作为起点，输入的目的地作为终点，第一微处理执行蚂蚁算法进行路径规划，输出最优导航路径(全局路径规划)。蚂蚁算法是设定一个起点，其他的都是需要拜访的点，所有点设为一个数组，循环设置每个点为起点，5G模组通过5G网络接入移动互联网并调用高德api获取这个点与其他各点之间的距离，自身点设为无穷大，获取到的是一个二维数组，为了性能，调用的是高德api的批量接口，防止频繁请求接口，得到的二维数组既是一个点与各个点之间的距离，通过模拟蚂蚁算法，得到最优解。
3)避障导航控制，包括：
3.1)利用激光雷达和人体红外线进行障碍检测，根据检测结果进行障碍物判断。对第二微处理进行逻辑设定，即，激光雷达和人体红外均检测到的物体定义为动态障碍物，激光雷达检测到、人体红外未检测到的物体定义为静态障碍物。激光雷达还用于障碍物测量和防撞控制。
3.2)如果是静态障碍物，则采取主动避让方式(即轮椅主动避让静态障碍物)。根据激光雷达测量到的障碍物的距离及其所在方位，第二微处理器执行人工势场法对障碍物产生斥力，得出无碰撞的引力引导下的最优避障路径(局部路径规划)；所述方位包括正前方、左前方和右前方。
人工势场包括引力场和斥力场，其中目标点对物体产生引力，引导物体朝向其运动，障碍物对物体产生斥力，避免物体与之发生碰撞，物体在路径上每一点所受的合力等于这一点所有斥力和引力的和。
3.3)如果是动态障碍物，则采取被动避让方式(即动态障碍物主动避让轮椅)。当检测到动态障碍物在正前方2-3米处时，第二微处理器则控制行进执行机构线性降速；当检测到动态障碍物在正前方1-2米处时，第二微处理器则控制行进执行机构由线性降速直至停止。当激光雷达和人体红外线检测到动态障碍物转移至左前方或右前方，或者距离轮椅正前方大于3米时，第二微处理器则控制行进执行机构线性提速直至额定转速。当激光雷达测量到动态障碍物距离1米以内，并且该动态障碍物无位移时，则将该动态障碍物转认定为静态障碍物，操作3.2步骤；
4)转向控制，包括：
4.1)在第三微处理器内运行计算，将步骤2.2的最优导航路径或者步骤3.2的最优避障路径，与轮椅当前位置坐标和当前姿态方位角进行比对，得到横向偏差e和航向角偏差θe，将两个偏差输入到内置在第三微处理器内的自适应模糊PID控制器中，控制器通过执行模糊自适应PID算法计算输出期望转角，其中，
横向偏差的计算方法，包括：
a)在最优导航路径或最优避障路径上取A、B两点，A、B两点连线为路径参考线；
b)轮椅当前位置为D点，通过步骤1.1和步骤1.2确定D点的位置坐标；
c)横向偏差e等于D点到路径参考线AB的垂线段距离L；
航向角偏差的计算方法，包括：
a)在最优导航路径或最优避障路径上取A、B两点，A、B两点连线为路径参考线，计算出路径参考线AB与中央子午线正北方的第一夹角θ1；
b)轮椅当前位置为D点，通过步骤1.1和步骤1.2确定D点的位置坐标；
c)根据电子罗盘的姿态方位角计算出当前行进方向与中央子午线正北方的第二夹角θ2；
d)航向角偏差θe等于第一夹角θ1和第二夹角θ2相减得到的值；
模糊自适应PID算法的步骤，包括：
a)输入变量模糊化，输入变量包括横向偏差e和航向角偏差θe，其中，
设定横向偏差e的基本论域为[-12cm，12cm],给定量化因子Kd为2，量化论域为[-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6]；
设定航向角偏差θe的基本论域为[-18°，18°],给定量化因子Ke为3，量化论域为[-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6]；
b)定义输入和输出隶属度函数，对模糊控制的输入和输出变量均采用三角形隶属度函数，其中输出变量为期望转角θu；
c)建立模糊规则，包括：对横向偏差e、航向角偏差θe、期望转角θu各定义7个模糊子集，并分别表示为[NB,NM,NS,ZE,PS,PM,PB]，制定模糊规则如下：
d)模糊推理，在模糊控制器中进行，设置模糊逻辑推理类型为Mamdani型，模糊逻辑推理的各参数设置如下：
| 参数 | 设置值 |
| And method | Min |
| Or method | Max |
| Implication | Min |
| Aggregation | Max |
| Defuzzification | centroid |
e)反模糊化，包括：找到输出隶属度函数曲线与坐标轴的横轴所围成面积的重心，将这个重心作为输出变量的代表点，对输出范围内几个连续点的重心进行计算，最终得出确定的控制量；
f)PID运算，将步骤e)得出的控制量输入PID控制器中，经PID运算后得出期望转角；
g)限幅输出，将步骤f)得出的期望转角输入限幅器中，对期望转角限幅输出，其中，限幅器设置输出上限幅为15°，下限幅为-15°。
4.2)转向执行机构将期望转角执行为实际转角；
4.3)实时检测转向执行机构的实际转角，并作为自适应模糊PID控制器的反馈，实时校正期望转角，控制轮椅行驶至目的地。
需要指出的是，上述较佳实施例仅为说明本发明的技术构思及特点，其目的在于让熟悉此项技术的人士能够了解本发明的内容并据以实施，并不能以此限制本发明的保护范围。凡根据本发明精神实质所作的等效变化或修饰，都应涵盖在本发明的保护范围之内。
Claims (7)
1.一种基于5G技术的自动驾驶轮椅，包括行进执行机构和转向执行机构，其特征在于还包括自动驾驶控制组件；所述自动驾驶控制组件包括：定位导航模块、避障控制模块、CAN总线模块和路径跟踪控制模块，其中，
所述定位导航模块通过CAN总线模块与路径跟踪控制模块耦接，并用于获取位置信息、姿态方位角和地图信息，并执行蚂蚁算法输出最优导航路径；
所述避障控制模块通过CAN总线模块与路径跟踪控制模块耦接，并用于检测行进路径前方的动态障碍物和静态障碍物，并执行人工势场法输出最优避障路径；
所述路径跟踪控制模块包括自适应模糊PID控制器，其接收当前位置坐标、当前姿态方位角、最优导航路径以及最优避障路径，并通过模糊自适应PID算法计算输出期望转角，并通过串口传送给转向执行机构。
2.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：所述定位导航模块包括安装在轮椅本体上的卫星导航接收器、电子罗盘、5G模组和第一微处理器，以及安装在室内的至少四个5G微基站；
所述卫星导航接收器与第一微处理器耦接，通过与导航卫星通信获取室外位置坐标并转送给第一微处理；
所述电子罗盘与第一微处理器耦接，用于获取姿态方位角并转送给第一微处理器；
所述至少四个5G微基站的其中一个5G微基站安装在电梯出入口处，其余5G微基站分散安装在室内，该至少四个5G微基站分别基于5G网络与5G模组无线通信，并分别向5G模组发送室内位置信息，室内位置信息内容包含：楼栋编号、楼层编号、伪距信号和位置坐标信号；
所述5G模组还接入5G移动互联网，实时下载地图信息，地图信息包括卫星地图信息和室内地图信息，5G模组还与第一微处理耦接，将地图信息和室内位置信息转送给第一微处理器，第一微处理器基于RSSI极大似然估计定位算法计算出室内位置坐标；
所述第一微处理器基于室外位置坐标或室内位置坐标，以及姿态方位角和地图信息，并执行蚂蚁算法进行路径规划，输出最优导航路径。
3.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：所述避障控制模块包括第二微处理器、激光雷达传感器和人体红外传感器；所述激光雷达传感器用于障碍物测量和防撞，所述人体红外传感器用于检测人体，所述第二微处理用于判断动态障碍物和静态障碍物。
4.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：所述路径跟踪控制模块还包括角度传感器，该角度传感器用于实时采集所述转向执行机构转动的转角值，并传送给自适应模糊PID控制器。
5.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：还包括人机交互模块，该人机交互模块为语音识别模块和/或触摸屏模块，其中所述语音识别模块包括话筒、语音放大电路和音频信号调制器。
6.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：所述转向执行机构包括两个转向轮、配接在该两个转向轮之间的转向同步组件、与转向同步组件相配接的转向驱动组件，其中，
所述转向同步组件包括固定杆、平动杆、第一连接件、第二连接件、第一连杆和第二连杆，第一连接件上设置有第一支杆和第二支杆，第二连接件上设置有第三支杆，其中，第一连接件和第二连接件分别铰接在固定杆的两端，第一支杆和第三支杆分别与平动杆的两端铰接，第二支杆与第一连杆的其中一端铰接，第一连杆的另一端与第二连杆的其中一端铰接。
所述转向驱动组件包括驱动电机、主动轮、从动轮和输出轴，其中，驱动电机通过其电机轴与主动轮相固定配接，主动轮与从动轮相啮合，从动轮还与输出轴的其中一端相固定配接，输出轴的另一端与第二连杆的另一端相固定配接。
7.根据权利要求1所述的基于5G技术的自动驾驶轮椅，其特征在于：所述行进执行机构包括两个行进驱动轮、行进驱动电机和差速器；其中，所述差速器包括壳体，以及设置在壳体内的主动锥齿轮、从动锥齿轮、行星轮架、两个行星轮和两个太阳轮，两个行星轮相互对称设置，并分别通过轴承连接在行星轮架内；两个太阳轮相互对称设置，并分别与两个行星轮相啮合，两个行进驱动轮分别通过轮轴与两个太阳轮相固定配接；从动锥齿轮固定套接在其中一根轮轴上；主动锥齿轮与行进驱动电机的电机轴相配接，并且与从动锥齿轮相啮合。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111012715.5A CN113721623A (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的自动驾驶轮椅 |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111012715.5A CN113721623A (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的自动驾驶轮椅 |
| CN202011175570.6A CN112327836B (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的轮椅自动驾驶控制方法及自动驾驶轮椅 |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011175570.6A Division CN112327836B (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的轮椅自动驾驶控制方法及自动驾驶轮椅 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113721623A true CN113721623A (zh) | 2021-11-30 |
Family
ID=74297136
Family Applications (3)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111012715.5A Withdrawn CN113721623A (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的自动驾驶轮椅 |
| CN202111012677.3A Withdrawn CN113721186A (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的室内定位方法 |
| CN202011175570.6A Active CN112327836B (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的轮椅自动驾驶控制方法及自动驾驶轮椅 |
Family Applications After (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111012677.3A Withdrawn CN113721186A (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的室内定位方法 |
| CN202011175570.6A Active CN112327836B (zh) | 2020-10-27 | 2020-10-27 | 基于5g技术的轮椅自动驾驶控制方法及自动驾驶轮椅 |
Country Status (1)
| Country | Link |
|---|---|
| CN (3) | CN113721623A (zh) |
Families Citing this family (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113288608B (zh) * | 2021-05-27 | 2022-10-18 | 中国科学院心理研究所 | 一种电动轮椅室内自动驾驶方法 |
| CN113655789A (zh) * | 2021-08-04 | 2021-11-16 | 东风柳州汽车有限公司 | 路径跟踪方法、装置、车辆及存储介质 |
| CN113936491B (zh) * | 2021-09-09 | 2022-05-13 | 山东金宇信息科技集团有限公司 | 一种基于5g网络的自动驾驶路况导航方法、系统及介质 |
| CN113566843B (zh) * | 2021-09-27 | 2022-10-11 | 宁波均联智行科技股份有限公司 | 一种导航切换方法及车载终端 |
| CN114115253A (zh) * | 2021-11-16 | 2022-03-01 | 浙江远图互联科技股份有限公司 | 一种基于改进型人工势场的医院智能机器人路径规划系统 |
| CN114374943A (zh) * | 2022-01-18 | 2022-04-19 | 瑞驰博方（北京）科技有限公司 | 楼层编号确定系统及方法 |
| CN114518116A (zh) * | 2022-02-17 | 2022-05-20 | 广州大学 | 一种基于跟踪导引线的视觉导航方法 |
Family Cites Families (25)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5667235A (en) * | 1993-07-27 | 1997-09-16 | Teksource, Lc | Multi-adjustable wheelchair |
| CA2270184C (en) * | 1996-10-11 | 2005-05-17 | Wheelchair Carrier, Inc. | Lightweight motorized wheelchair |
| CN101923345A (zh) * | 2010-09-10 | 2010-12-22 | 天津科技大学 | 电动轮椅智能控制系统 |
| AU2012340510B2 (en) * | 2011-11-27 | 2017-05-18 | Stryker Corporation | Wheeled chair |
| CN102600026A (zh) * | 2012-03-09 | 2012-07-25 | 常州汉迪机器人科技有限公司 | 全向智能电动轮椅 |
| CA3123791C (en) * | 2013-03-15 | 2023-05-02 | Stryker Corporation | Medical support apparatus |
| CN104898664A (zh) * | 2015-04-10 | 2015-09-09 | 哈尔滨力盛达机电科技有限公司 | 一种农用全地形车转向跟踪复合控制方法 |
| DE102015119501A1 (de) * | 2015-11-11 | 2017-05-11 | RobArt GmbH | Unterteilung von Karten für die Roboternavigation |
| CN206424228U (zh) * | 2016-10-19 | 2017-08-22 | 南宁市第一人民医院 | 一种具有肩部按摩功能的后驱自行轮椅 |
| CN106864436A (zh) * | 2017-03-14 | 2017-06-20 | 长安大学 | 一种无人驾驶车辆制动系统及制动方法 |
| CN107507048A (zh) * | 2017-05-20 | 2017-12-22 | 吕怀民 | “用联网”方法、联网可用物品、网络许可使用装置及用途 |
| CN107149322A (zh) * | 2017-07-12 | 2017-09-12 | 安徽信息工程学院 | 基于蓝牙4.0的智能移动座椅及其控制系统 |
| US11075910B2 (en) * | 2017-08-10 | 2021-07-27 | Patroness, LLC | Secure systems architecture for integrated motorized mobile systems |
| US10656652B2 (en) * | 2017-08-10 | 2020-05-19 | Patroness, LLC | System and methods for sensor integration in support of situational awareness for a motorized mobile system |
| CN107479378A (zh) * | 2017-08-18 | 2017-12-15 | 国家康复辅具研究中心 | 一种基于模糊pid控制的电动轮椅控制系统 |
| US10814751B2 (en) * | 2017-12-04 | 2020-10-27 | Continental Automotive Gmbh | Method for adjusting a temperature of a seat |
| CN108478348B (zh) * | 2018-05-29 | 2023-12-01 | 华南理工大学 | 一种室内自主导航物联的智能轮椅车及控制方法 |
| CN108646747A (zh) * | 2018-06-05 | 2018-10-12 | 上海交通大学 | 农用车辆路径跟踪控制方法 |
| CN110250785B (zh) * | 2019-06-05 | 2022-01-07 | 云南中商正晓农业科技有限公司 | 一种智慧式床椅车共享系统 |
| KR20190087355A (ko) * | 2019-07-05 | 2019-07-24 | 엘지전자 주식회사 | 영역별 인체 활동 데이터를 이용하여 주행하는 청소로봇 및 청소로봇을 주행시키는 방법 |
| KR102135254B1 (ko) * | 2019-08-20 | 2020-07-20 | 엘지전자 주식회사 | 차량 내 사용자 모니터링을 위한 배경 이미지 생성 방법 및 이를 위한 장치 |
| CN110716563A (zh) * | 2019-09-26 | 2020-01-21 | 山东理工大学 | 一种基于电子地图给定轨迹的电动轮椅路径跟踪控制方法与装置 |
| CN110839279A (zh) * | 2019-10-21 | 2020-02-25 | 深圳数位传媒科技有限公司 | 一种基于5g信号的智能终端定位方法及装置 |
| CN111107495B (zh) * | 2019-12-02 | 2021-07-09 | 南京中科晶上通信技术有限公司 | 基于5g的用户终端、导航定位系统及导航定位方法 |
| CN111547145A (zh) * | 2020-05-26 | 2020-08-18 | 北京联博达科技有限公司 | 一种多模驾驶履带式电动运载装置和方法 |
-
2020
- 2020-10-27 CN CN202111012715.5A patent/CN113721623A/zh not_active Withdrawn
- 2020-10-27 CN CN202111012677.3A patent/CN113721186A/zh not_active Withdrawn
- 2020-10-27 CN CN202011175570.6A patent/CN112327836B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN113721186A (zh) | 2021-11-30 |
| CN112327836A (zh) | 2021-02-05 |
| CN112327836B (zh) | 2021-10-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112327836B (zh) | 基于5g技术的轮椅自动驾驶控制方法及自动驾驶轮椅 | |
| CN113945206B (zh) | 一种基于多传感器融合的定位方法及装置 | |
| US11915492B2 (en) | Traffic light recognition method and apparatus | |
| US20220229436A1 (en) | Real-time lane change selection for autonomous vehicles | |
| JP6928722B2 (ja) | 車両動作のための位置特定の決定 | |
| US10782384B2 (en) | Localization methods and systems for autonomous systems | |
| CN107390703A (zh) | 一种智能化导盲机器人及其导盲方法 | |
| Li et al. | Localization and navigation for indoor mobile robot based on ROS | |
| WO2019098002A1 (ja) | 情報処理装置、情報処理方法、プログラム、及び移動体 | |
| CN207281590U (zh) | 一种智能化导盲机器人装置 | |
| US20200159233A1 (en) | Memory-Based Optimal Motion Planning With Dynamic Model For Automated Vehicle | |
| Fu et al. | Path planning and decision making for autonomous vehicle in urban environment | |
| JP2019007964A (ja) | Ｕａｖの位置を推定するシステム及び方法 | |
| CN109656257B (zh) | 封闭园区无人驾驶车辆控制系统及方法 | |
| US20230111327A1 (en) | Techniques for finding and accessing vehicles | |
| CN108356829B (zh) | 两轮自平衡引导机器人 | |
| CN114264306A (zh) | 室内外相结合的配送机器人及配送方法 | |
| US10332402B2 (en) | Movement assistance system and movement assistance method | |
| US20210357667A1 (en) | Methods and Systems for Measuring and Mapping Traffic Signals | |
| CN113777589A (zh) | 一种基于点特征的lidar与gps/imu联合标定方法 | |
| CN112965494A (zh) | 固定区域纯电动自动驾驶专用车控制系统及方法 | |
| Jarvis | An all-terrain intelligent autonomous vehicle with sensor-fusion-based navigation capabilities | |
| Smaili et al. | Multi-sensor fusion method using bayesian network for precise multi-vehicle localization | |
| US20230278592A1 (en) | Service area maps for autonomous vehicles | |
| CN116552261B (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 | ||
| WW01 | Invention patent application withdrawn after publication |
Application publication date: 20211130 |
|
| WW01 | Invention patent application withdrawn after publication |