CN111061279B - 一种电动病床的室内自适应巡航控制系统及方法 - Google Patents
一种电动病床的室内自适应巡航控制系统及方法 Download PDFInfo
- Publication number
- CN111061279B CN111061279B CN202010005709.6A CN202010005709A CN111061279B CN 111061279 B CN111061279 B CN 111061279B CN 202010005709 A CN202010005709 A CN 202010005709A CN 111061279 B CN111061279 B CN 111061279B
- Authority
- CN
- China
- Prior art keywords
- sickbed
- switching
- electric
- mode
- distance
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 13
- 230000000875 corresponding effect Effects 0.000 claims abstract description 10
- 230000008447 perception Effects 0.000 claims abstract description 7
- 230000001276 controlling effect Effects 0.000 claims abstract description 5
- 230000003044 adaptive effect Effects 0.000 claims description 13
- 238000013459 approach Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 7
- 230000000474 nursing effect Effects 0.000 abstract description 2
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002265 prevention Effects 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/0275—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/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, 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Electromagnetism (AREA)
- Fuzzy Systems (AREA)
- Business, Economics & Management (AREA)
- Game Theory and Decision Science (AREA)
- Acoustics & Sound (AREA)
- Multimedia (AREA)
- Mathematical Physics (AREA)
- Invalid Beds And Related Equipment (AREA)
Abstract
本发明公开了一种电动病床的室内自适应巡航控制系统及方法,包括:存储模块,所述存储模块预置有设定场所内的电子导航地图;信息感知模块,用于获取电动病床周边物体的形态以及相对运动信息;控制决策模块,用于根据获取的电动病床周边物体信息,得到电动病床与障碍物之间的实际间距、期望间距、相对速度与角度,进而得到电动病床的运动模式切换策略指令;控制执行模块,用于根据接收到的运动模式切换策略指令,控制电动病床执行相应的动作。本发明能够将电动病床和自适应巡航系统结合,实现电动病床在室内的有效而又安全的慢速移动,提高移动过程中的安全性与舒适性,同时减轻医护人员的护理压力、体力消耗,实现病房内的自动高效管理。
Description
技术领域
本发明属于医疗设备技术领域,尤其涉及一种电动病床的室内自适应巡航控制系统及方法。
背景技术
随着医院需求和患者需要的增加以及控制技术的进步,病床不管是医用还是家用,都逐渐由手动转向电动控制。目前电动病床主要是控制床位状态的改变即病人体位的改变,而对于病床的移动控制相对较少,病床的移动主要靠人力推停、移动。患者人数的增加,病房医护人员精力有限,使电动病床的移动控制显得尤为重要。
随着控制技术的发展,自适应巡航控制系统(ACC)主要应用在汽车方面,辅助驾驶员完成车辆的驾驶工作,实现车辆纵向驱动与制动工作。且集成了车辆的碰撞警告、碰撞预防功能,保证车辆行驶过程中的安全性和舒适性。电动病床的移动控制同样需要识别前进路线中出现的障碍物,控制与障碍物的间距及防碰撞,并进行转动等操作避开障碍物等,但病床是在室内进行的,不同于汽车行驶的慢速移动,病床的室内自适应巡航需要更精准的移动控制。
发明内容
本发明的目的就是为了解决上述问题,提出了一种电动病床的室内自适应巡航控制系统及方法,可以实现电动病床在室内的有效而又安全的慢速移动,提高移动过程中的安全性。
为实现上述目的,本发明的具体方案如下:
一种电动病床的室内自适应巡航控制系统,包括:
存储模块,所述存储模块预置有设定场所内的电子导航地图,所述电子导航地图配置有所有房间的位置信息以及固有物体的名称及形态类目;
信息感知模块,用于获取电动病床周边物体的形态以及相对运动信息;
控制决策模块,用于根据获取的电动病床周边物体的形态以及相对运动信息,得到电动病床与障碍物之间的实际间距、期望间距、相对速度与角度,进而得到电动病床的运动模式切换策略指令;
控制执行模块,用于根据接收到的运动模式切换策略指令,控制电动病床执行相应的动作。
控制决策模块根据获取的电动病床周边物体的形态以及相对运动信息,确定电动病床的运动模式切换策略,具体为:
驱动匀速模式下,如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且相对速度小于速度切换阈值与根据速度设置的回滞之和,则切换到制动减速模式;如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;
制动减速模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且相对速度大于速度切换阈值与根据速度设置的回滞之差,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;如果满足电动病床与障碍物之间的实际间距趋近于零,则切换到紧急制动模式;
横向转动模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且障碍物与病床前端夹角大于设定角度值,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角大于设定角度值,则切换到制动减速模式;
紧急制动模式下,如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式。
在另一些实施方式中,采用如下技术方案:
一种电动病床的室内自适应巡航控制方法,包括:
获取电动病床周边物体的形态以及相对运动信息;
根据获取的电动病床周边物体的形态以及相对运动信息,基于预先存储的病房内的电子导航地图,得到电动病床与障碍物之间的实际间距、期望间距、相对速度与角度,进而得到电动病床的运动模式切换策略指令;
根据接收到的运动模式切换策略指令,控制电动病床执行相应的动作。
在另一些实施方式中,采用如下技术方案:
一种电动病床,包括:上述的电动病床的室内自适应巡航控制系统。
本发明的有益效果:
1.本发明的电动病床的室内自适应巡航控制系统,能够将电动病床和自适应巡航系统结合,实现电动病床在室内的有效而又安全的慢速移动,提高移动过程中的安全性与舒适性,同时减轻医护人员的护理压力、体力消耗,实现病房内的自动高效管理。
2.本发明的电动病床的室内自适应巡航控制系统,通过信息感知层获得的与周边物体的相对位置运动信息,能够自动调整移动速度、移动角度,从而提高了提高移动过程中的安全性。
3.本发明的电动病床的室内自适应巡航控制系统,优化了驱动制动切换算法,有效地减少了驱动制动执行器之间的切换次数,减少病床的机械损耗。
附图说明
图1为本发明实施例一中电动病床的室内自适应巡航控制系统结构示意图;
图2为本发明实施例一中混合型模糊PID控制器结构示意图;
图3为本发明实施例一中电动病床运动模式切换示意图。
具体实施方式:
下面结合附图对本发明进行详细说明:
实施例一
本发明实施例公开了一种电动病床的室内自适应巡航控制系统,配以所在医院等场所的房间名称及位置的电子导航图,常用的固有的仪器等物体名称及形态类目。
电动病床的室内自适应巡航控制系统结构如图1所示,采用分层式控制形式,包括:信息感知层、控制决策层、控制执行层三部分。
其中,信息感知层获得周边物体形态如长宽高等,材质如金属、塑料等,运动状态如静止、速度、方向等,与周边物体的相对运动信息,如距离、相对速度、方向夹角等。信息感知层包括三维扫描仪、毫米波雷达、超声波测距仪、红外摄像头及角速度传感器。
设置在病床前端的毫米波雷达发现前进路径中的障碍物后,超声波测距仪测出目标病床与障碍物的相对距离,三维扫描仪扫描判断物体形态、种类,速度传感器测出速度,角速度传感器测出角度差;红外摄像头用于采集红外信息,判定障碍物是否为人和动物。
控制决策层对信息感知层提供的信息进行分析,并与系统内已有的常规物体类目匹配判断是什么物体,进而通过控制算法得到相应的模式。
控制决策层包括:控制器单元与模式切换单元,控制器单元实现驱动匀速、制动减速,紧急制动和横向转动各个运动模式的控制;模式切换单元实现各个模式控制之间的平滑切换。
控制决策层的算法为混合型模糊PID控制算法,通过混合型模糊PID控制器实现;
电动病床的驱动匀速模式,采用增量式PID就能够有很好的控制效果。对于制动减速等模式,采用混合型模糊PID控制器,是由一个比例积分控制器和一个二维模糊控制器并联而成。该控制器可以消除系统余差和极限环振荡,使系统成为无差模糊控制系统。
混合型模糊PID控制器结构如图2所示,Sd为期望距离,d为期望距离与实际距离之差,v为相对速度;在图2中,模糊控制器的2个输入分别为d和v,输出为驱动力与制动力的平衡差。模糊控制器其实就相当于一个PD控制器,但性能要优于PD控制器。增量式PID控制器的输入为电动病床与障碍物之间的期望距离与实际距离之差,输出为驱动力与制动力的平衡差,用于模式切换的驱动电信号。
本实施方式的混合型模糊PID控制器,弥补了模糊控制器存在着较大静差和在设定点附近形成极限环振荡的不足。
假设模糊控制器的输出为uo(kT),基于驱动匀速模式和制动减速模式平稳切换的考虑,采用增量式模糊控制器结构。
Δuo(kT)=uo(kT)-uo[(k-1)T]
增量式PID控制器的输出为
Δut(kT)=KP{E(kT)-E[(k-1)T]}+KI{E(kT)}
整个控制器的输出Δu(kT)为
Δu(kT)=Δut(kT)+KDΔuo(kT)
=KP{E(kT)-E[(k-1)T]}+KI{E(kT)}+KD{uo(kT)-uo[(k-1)T]}
其中,KP、KI、KD分别为PID控制器的比例、积分、微分系数矩阵;E(kT)、E(kT)-E[(k-1)T]分别为输入变量偏差、输入变量偏差变化。
参量作为控制器模块的输出,及模式切换模块的输入,通过模式切换模块预设信息结合完成电动病床控制。
增量式PID控制器的输出与模糊控制器的输出之和得到运动模式切换控制指令,用于模式切换的驱动电信号。
控制决策层的模式切换模块,基于获得的实际间距、期望间距、相对速度与角度,设置相应的切换条件,实现各个控制器的平滑切换,为防止控制器间的频繁切换,在切换条件中加入回滞策略。
其中,d为与障碍物实际间距,dth为间距切换阈值,dh为根据间距设置的回滞,Δv为相对速度,vth为速度切换阈值,vh为根据速度设置的回滞,θ为障碍物与病床前端夹角。
参照图3,驱动匀速模式下,如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且相对速度小于速度切换阈值与根据速度设置的回滞之和,则切换到制动减速模式;如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;
制动减速模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且相对速度大于速度切换阈值与根据速度设置的回滞之差,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;如果满足电动病床与障碍物之间的实际间距趋近于零,则切换到紧急制动模式;
横向转动模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且障碍物与病床前端夹角大于设定角度值,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角大于设定角度值,则切换到制动减速模式;
紧急制动模式下,如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式。
下面以病人在最外侧病房,需要到护士站对面的检查室做术前检查为例对本实施例电动病床的室内自适应巡航控制系统的工作过程说明如下:
1、医护人员在远程操作平板上选择目标病床,选择目的地,系统自动选择最优线路,启动;
2、电动病床启动后,在移动过程中,病床前端的毫米波雷达发现前进路径中的障碍物后,超声波测距仪测出目标病床与障碍物的相对距离,三维扫描仪扫描判断物体形态、种类,速度传感器测出速度,角速度传感器测出角度差;
3、上述信息上传到决策层,算法得出相应应执行的模式,模式切换控制器选择相应的模式控制器启动;
4、执行层得到指令后,进行相应控制。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。
Claims (6)
1.一种电动病床的室内自适应巡航控制系统,其特征在于,包括:
存储模块,所述存储模块预置有设定场所内的电子导航地图,所述电子导航地图配置有所有房间的位置信息以及固有物体的名称及形态类目;
信息感知模块,用于获取电动病床周边物体的形态以及相对运动信息;
控制决策模块,用于根据获取的电动病床周边物体的形态以及相对运动信息,得到电动病床与障碍物之间的实际间距、期望间距、相对速度与角度,进而得到电动病床的运动模式切换策略指令;
控制执行模块,用于根据接收到的运动模式切换策略指令,控制电动病床执行相应的动作;
所述控制决策模块根据获取的电动病床周边物体的形态以及相对运动信息,确定电动病床的运动模式切换策略,具体为:
驱动匀速模式下,如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且相对速度小于速度切换阈值与根据速度设置的回滞之和,则切换到制动减速模式;如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;
制动减速模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且相对速度大于速度切换阈值与根据速度设置的回滞之差,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;如果满足电动病床与障碍物之间的实际间距趋近于零,则切换到紧急制动模式;
横向转动模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且障碍物与病床前端夹角大于设定角度值,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角大于设定角度值,则切换到制动减速模式;
紧急制动模式下,如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式。
2.如权利要求1所述的一种电动病床的室内自适应巡航控制系统,其特征在于,所述信息感知模块包括三维扫描仪、毫米波雷达、超声波测距仪、红外摄像头及角速度传感器。
3.如权利要求1所述的一种电动病床的室内自适应巡航控制系统,其特征在于,所述电动病床的运动模式包括:驱动匀速模式、制动减速模式,紧急制动模式和横向转动模式。
4.如权利要求1所述的一种电动病床的室内自适应巡航控制系统,其特征在于,采用混合型模糊PID控制算法实现电动病床的运动模式切换,所述混合型模糊PID控制算法通过混合型模糊PID器实现,所述混合型模糊PID器包括:模糊控制器和增量式PID控制器;
模糊控制器的输入分别为电动病床与障碍物之间的期望距离与实际距离之差和电动病床的相对速度,输出为驱动力与制动力的平衡差;
增量式PID控制器的输入为电动病床与障碍物之间的期望距离与实际距离之差,输出为驱动力与制动力的平衡差;
增量式PID控制器的输出与模糊控制器的输出之和得到运动模式切换控制指令。
5.一种电动病床的室内自适应巡航控制方法,其特征在于,包括:
获取电动病床周边物体的形态以及相对运动信息;
根据获取的电动病床周边物体的形态以及相对运动信息,基于预先存储的病房内的电子导航地图,得到电动病床与障碍物之间的实际间距、期望间距、相对速度与角度,进而得到电动病床的运动模式切换策略指令;
根据接收到的运动模式切换策略指令,控制电动病床执行相应的动作;
根据获取的电动病床周边物体的形态以及相对运动信息,确定电动病床的运动模式切换策略,具体为:
驱动匀速模式下,如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且相对速度小于速度切换阈值与根据速度设置的回滞之和,则切换到制动减速模式;如果满足电动病床与障碍物之间的实际间距小于间距切换阈值与根据间距设置的回滞之和,且障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;
制动减速模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且相对速度大于速度切换阈值与根据速度设置的回滞之差,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式;如果满足电动病床与障碍物之间的实际间距趋近于零,则切换到紧急制动模式;
横向转动模式下,如果满足电动病床与障碍物之间的实际间距大于间距切换阈值与根据间距设置的回滞之差,且障碍物与病床前端夹角大于设定角度值,则切换到驱动匀速模式;如果满足障碍物与病床前端夹角大于设定角度值,则切换到制动减速模式;
紧急制动模式下,如果满足障碍物与病床前端夹角小于设定角度值,则切换到横向转动模式。
6.一种电动病床,其特征在于,包括:权利要求1-4任一项所述的电动病床的室内自适应巡航控制系统。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010005709.6A CN111061279B (zh) | 2020-01-03 | 2020-01-03 | 一种电动病床的室内自适应巡航控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010005709.6A CN111061279B (zh) | 2020-01-03 | 2020-01-03 | 一种电动病床的室内自适应巡航控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111061279A CN111061279A (zh) | 2020-04-24 |
CN111061279B true CN111061279B (zh) | 2020-12-08 |
Family
ID=70304862
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010005709.6A Active CN111061279B (zh) | 2020-01-03 | 2020-01-03 | 一种电动病床的室内自适应巡航控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111061279B (zh) |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3531445B2 (ja) * | 1997-11-19 | 2004-05-31 | 日産自動車株式会社 | 車載情報装置 |
JP3994859B2 (ja) * | 2002-11-19 | 2007-10-24 | 株式会社ジェイテクト | トルク検出装置及びそれを備えた電動パワーステアリング制御装置 |
JP2006042493A (ja) * | 2004-07-27 | 2006-02-09 | Canon Inc | モータ制御装置及びその制御方法 |
US9457802B2 (en) * | 2012-04-06 | 2016-10-04 | Richard Louis Ponziani | Turn signal controlled regenerative braking and decelerative loading |
CN103676950A (zh) * | 2013-04-01 | 2014-03-26 | 常熟理工学院 | 一种语音控制的医疗服务机器人 |
DE102016212077A1 (de) * | 2016-07-04 | 2018-01-04 | Siemens Healthcare Gmbh | Verfahren zum Betrieb einer wenigstens teilweise autonom bewegten, mobilen medizintechnischen Einheit und mobile medizintechnische Einheit |
CN107783119A (zh) * | 2016-08-25 | 2018-03-09 | 大连楼兰科技股份有限公司 | 应用在避障系统中的决策融合方法 |
CN106427991B (zh) * | 2016-09-26 | 2018-10-19 | 广州汽车集团股份有限公司 | 基于混合动力汽车的工作模式控制系统及控制方法 |
CN106774347A (zh) * | 2017-02-24 | 2017-05-31 | 安科智慧城市技术(中国)有限公司 | 室内动态环境下的机器人路径规划方法、装置和机器人 |
CN108189835B (zh) * | 2017-12-28 | 2020-04-21 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶的避撞控制方法及系统 |
CN109002041B (zh) * | 2018-08-09 | 2021-03-19 | 北京智行者科技有限公司 | 一种车辆避障方法 |
CN208781070U (zh) * | 2018-10-29 | 2019-04-23 | 长春市宝成伟业汽车零部件有限公司 | 智能寄送件小车系统 |
CN109808507B (zh) * | 2018-12-31 | 2022-04-29 | 河南嘉晨智能控制股份有限公司 | 一种适用于电动叉车的驻坡溜坡综合控制系统 |
CN110262495B (zh) * | 2019-06-26 | 2020-11-03 | 山东大学 | 可实现移动机器人自主导航与精确定位的控制系统及方法 |
-
2020
- 2020-01-03 CN CN202010005709.6A patent/CN111061279B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111061279A (zh) | 2020-04-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Automatic parking of vehicles: A review of literatures | |
CN107042828B (zh) | 车辆操作状态 | |
Vorobieva et al. | Automatic parallel parking in tiny spots: Path planning and control | |
EP2302480B1 (en) | Wheelchair and method for correcting the guidance of a wheelchair | |
JP6689126B2 (ja) | 作業車両制御システム | |
CN108791278A (zh) | 侧方位泊车控制系统及其控制方法 | |
US8494741B2 (en) | Control device for vehicle | |
US20200180661A1 (en) | Vehicle and apparatus and method for controlling the same | |
JP5262368B2 (ja) | 駐車支援装置および駐車支援方法 | |
CN107097241A (zh) | 一种服务机器人及其控制方法 | |
CN111516752A (zh) | 一种自动驾驶车辆的人机共驾转向控制方法 | |
CN110155163A (zh) | 一种无人驾驶转向系统及车辆 | |
JPH1049230A (ja) | 道路条件による制御機能を具備した無人自動車システム | |
JP2020160885A (ja) | 車両の走行制御装置 | |
CN106364476A (zh) | 车辆的驾驶辅助装置 | |
CN111061279B (zh) | 一种电动病床的室内自适应巡航控制系统及方法 | |
Rabhi et al. | Intelligent joystick for controlling power wheelchair navigation | |
KR101977416B1 (ko) | 스마트 전기자동차 및 이의 운용방법 | |
Ullah et al. | Integrated collision avoidance and tracking system for mobile robot | |
US5142209A (en) | Automatic repositioning of mirrors mounted within concave-shaped boundaries | |
JP2007302040A (ja) | 駐車支援装置 | |
JP2020166422A (ja) | 自律移動ロボット | |
KR20130142345A (ko) | 스마트 전기자동차 및 이의 운용방법 | |
Ueno et al. | Design and control for collision avoidance of power-assisted omni-directional mobile wheelchair system | |
CN111390922A (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 |