CN106667684A - 一种双核单轮驱动高速机器人电动病床控制器 - Google Patents
一种双核单轮驱动高速机器人电动病床控制器 Download PDFInfo
- Publication number
- CN106667684A CN106667684A CN201610600752.0A CN201610600752A CN106667684A CN 106667684 A CN106667684 A CN 106667684A CN 201610600752 A CN201610600752 A CN 201610600752A CN 106667684 A CN106667684 A CN 106667684A
- Authority
- CN
- China
- Prior art keywords
- motor
- fpga
- electric
- robot
- controller
- 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.)
- Pending
Links
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
- A61G7/05—Parts, details or accessories of beds
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1669—Programme controls characterised by programming, planning systems for manipulators characterised by special application, e.g. multi-arm co-operation, assembly, grasping
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0421—Multiprocessor system
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/10—General characteristics of devices characterised by specific control means, e.g. for adjustment or steering
- A61G2203/16—Touchpads
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/10—General characteristics of devices characterised by specific control means, e.g. for adjustment or steering
- A61G2203/22—General characteristics of devices characterised by specific control means, e.g. for adjustment or steering for automatically guiding movable devices, e.g. stretchers or wheelchairs in a hospital
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/30—General characteristics of devices characterised by sensor means
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/30—General characteristics of devices characterised by sensor means
- A61G2203/36—General characteristics of devices characterised by sensor means for motion
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/70—General characteristics of devices with special adaptations, e.g. for safety or comfort
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Nursing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Invalid Beds And Related Equipment (AREA)
Abstract
本发明公开了一种双核单轮驱动高速机器人电动病床控制器,包括交流电源、电池、控制板、第一电机、第二电机以及机器人电动病床,所述的控制板采用双核控制器,包括DSP和FPGA,所述的FPGA接受传感器反馈的传感器信号,由所述的FPGA发出第一控制信号和第二控制信号,所述的第一电机和第二电机上设置有磁电编码器,通过磁电编码器由所述的第一电机和第二电机控制所述的机器人电动病床的前进、运行速度和运行方向。通过上述方式,本发明在保证稳定性和安全性的前提下,通过电动助力不仅可以减少护工或者护士人员的劳动量和劳动强度,而且多种传感器组合使得机器人电动病床具有多种功能,可以满足不同条件下病人对病床的需求。
Description
技术领域
本发明涉及一种双核单轮驱动高速医用机器人电动病床自动控制系统。属于自动电动病床领域。
背景技术
医用病床系统是一种用于医院病房内提供承载患者的设备。目前发达国家医院中使用的医用病床基本上全部自动化,家庭病床、社区医院病床也已经使用多功能电动床。部分医用病床可以通过外力改变形状达到辅助调整患者体位的目的,其中有些附件具有促进患者康复的效果;可控制电动病床是相对高级的自动化产品,具有省时省力的优点。由于电控制的特点,控制键可以安装在任何允许病床接受到信号的范围内,提高了控制的自由度。通过附件升级,还可以实现权限分配。电动驱动产品精度更高,便于流水线作业,已作为ICU重症监护室、手术室、造影室等中使用的特种医用病床。
我国在医用电动病床领域的研究开发相对滞后,整体水平不高,现国内各级医院均是采用普通的机械病床:由床腿、床体和床面组成。为了移动方便移动,一般均在床腿上设置机械滚动滑轮;为了方便病人坐起,均在床头部分设置机械手动摇起装置。对于这类型病床,一般均需要护理人员帮助,很难独自完成,同时病床功能单一,实用性能不强。
长时间运行发现存在着很多安全隐患和不便,即:
(1)现有的部分病床通过四个固定站脚与地面接触起到支撑作用,病人均被固定在某一个封闭的环境中,随着病人长时间的住院,对病人的身心造成了极大的伤害;
(2)虽然部分病床把固定站脚改为了机械万向轮,可以通过医护人员移动病床到某个空间,但是由于病床移动随意性较大,有时候会出现误操作,甚至有时候会伤害到病人;
(3)随着现代人类生活质量的增加,肥胖病人大量增加,而护士人员一般又都比较瘦小,通过机械万向轮移动病人使得护士人员非常吃力,加重了劳动强度;
(4)随着老龄化的加重,大量的老人也加重了对病床的需求,现在的护工人员又比较少,基于机械万向轮的病床加重了护工人员的劳动强度;
(5)所有的机械病床一般均固定在某个位置,一旦需要移动或者变换方向均需要外部人员完成,加重了护工人员的劳动量;
(6)现在的机械病床即使可以通过外力通过病房门口被推到外部环境中,由于人为操作的自动化程度比较低,通过病房门口都需要点时间调整病床的姿态才可以通过;
(7)现在的机械病床即使可以通过机械万向轮的支撑到达病房以外的环境,在调节了病人身心的同时,也加大了护工人员的劳动量,特别是通过爬坡的地方时,对护工人员的体力提出了更高的要求;
(8)基于单核控制的机器人电动病床,既要处理多轴电机的伺服控制,又要处理机器人病床的多种传感器采样数据,由于单核处理器处理的数据较多,运算速度不是很快,不利于机器人高速运转,而且有时候由于处理数据较多导致机器人病床失控;
(9)由于机器人电动病床在运行过程中频繁的刹车和启动,加重了单核控制器的工作量,单核控制器无法满足机器人电动病床快速启动和停车的要求;
(10)由于受周围环境不稳定因素干扰,单核机器人电动病床控制器经常会出现异常,引起机器人病床在行驶过程中失控,抗干扰能力较差;
(11)虽然基于专用伺服控制芯片可以生成多轴电机的PWM控制信号,但是需要主控制器与专用芯片通讯后输入控制参数才可以实现,造成整体运算速度降低;
(12)受专用伺服控制芯片内部伺服程序的影响,一般情况下伺服控制PID参数不能实时更改,满足不了电动病床实时快速伺服控制系统的要求。
发明内容
本发明主要解决的技术问题是提供一种双核单轮驱动高速机器人电动病床控制器,为克服普通医院病床不能满足病人实际要求,在吸收国外先进控制思想的前提下,自主研发了一款基于DSP(TMS320F2812)+FPGA(A3P250)的全新双核单轮驱动机器人电动病床,此机器人控制系统以FPGA(A3P250)为处理核心,实现两轴直流无刷电机的同步伺服控制,TMS320F2812实现多种传感器信号的数字信号实时处理,并实时相应各种中断保护请求,并实现与FPGA(A3P250)数据通信。
为解决上述技术问题,本发明采用的一个技术方案是:提供了一种双核单轮驱动高速机器人电动病床控制器,包括交流电源、电池、控制板、第一电机、第二电机以及机器人电动病床,所述的交流电源和电池提供电流驱动所述的控制板,所述的控制板采用双核控制器,包括DSP和FPGA,所述的DSP和FPGA进行通信连接,所述的机器人电动病床上设有传感器,所述的FPGA接受传感器反馈的传感器信号,由所述的FPGA发出第一控制信号和第二控制信号,所述的第一控制信号和第二控制信号经驱动放大后驱动所述的第一电机和第二电机,所述的第一电机和第二电机上设置有磁电编码器,通过磁电编码器由所述的第一电机和第二电机控制所述的机器人电动病床的前进、运行速度和运行方向。
在本发明一个较佳实施例中,所述的电池采用锂离子电池。
在本发明一个较佳实施例中,所述的第一电机和第二电机均采用高速直流无刷伺服电机。
在本发明一个较佳实施例中,所述的DSP采用TMS320F2812;所述的FPGA采用A3P250。
在本发明一个较佳实施例中,所述的传感器包括加速度计和陀螺仪。
在本发明一个较佳实施例中,所述的第一控制信号和第二控制信号均为PWM波控制信号。
在本发明一个较佳实施例中,所述的双核单轮驱动高速机器人电动病床控制器还设置有人机界面程序和运动控制系统,所述的人机界面程序包括人机界面、路径规划以及在线输出,所述的运动控制系统包括基于FPGA两轴直流无刷电机伺服控制、数据存储以及I/O控制,其中,所述的基于FPGA两轴直流无刷电机伺服控制包括DA模块、磁电编码器模块、加速度计和陀螺仪加速度模块、基于磁电传感器速度模块以及基于磁电传感器位移模块。
本发明的有益效果是:本发明的双核单轮驱动高速机器人电动病床控制器,设计了一款基于现场可编程门阵列FPGA的双核单轮驱动的机器人电动病床,这种病床在保证稳定性和安全性的前提下,通过电动助力不仅可以减少护工或者护士人员的劳动量和劳动强度,而且多种传感器组合使得机器人电动病床具有多种功能,可以满足不同条件下病人对病床的需求。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图,其中:
图1为本发明基于 DSP+FPGA双核单轮驱动高速医用病床原理图;
图2为本发明基于 DSP+ FPGA双核单轮驱动高速机器人电动病床程序框图;
图3为基于 DSP+ FPGA双核单轮驱动高速机器人电动病床运动原理框图;
图4为基于 DSP+ FPGA双核单轮驱动高速机器人电动病床通过病房门口自动导航原理图。
具体实施方式
下面将对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
如图1所示,本实施例包括:
一种双核单轮驱动高速机器人电动病床控制器,包括交流电源、电池、控制板、第一电机、第二电机以及机器人电动病床,所述的交流电源和电池提供电流驱动所述的控制板,所述的控制板采用双核控制器,包括DSP和FPGA,所述的DSP和FPGA进行通信连接,所述的机器人电动病床上设有传感器,所述的FPGA接受传感器反馈的传感器信号,由所述的FPGA发出第一控制信号和第二控制信号,所述的第一控制信号和第二控制信号经驱动放大后驱动所述的第一电机和第二电机,所述的第一电机和第二电机上设置有磁电编码器,通过磁电编码器由所述的第一电机和第二电机控制所述的机器人电动病床的前进、运行速度和运行方向。
本实施例中,所述的电池采用锂离子电池;所述的第一电机和第二电机均采用高速直流无刷伺服电机。
进一步的,所述的DSP采用TMS320F2812;所述的FPGA采用A3P250。
随着微电子技术和计算机集成芯片制造技术的不断发展和成熟,数字信号处理芯片DSP由于其快速的计算能力,不仅广泛应用于通信与视频信号处理,也逐渐应用在各种高级的控制系统中。TMS320F2812 是美国TI 公司推出的C2000 平台上的定点32 位DSP 芯片,运行时钟也快可达150MHz,处理性能可达150MIPS,每条指令周期6.67ns。TMS320F2812的IO口非常丰富,具有两个串口,具有12位的0~3.3v的AD转换等,具有片内128k×16位的片内FLASH,18K ×16 位的SRAM,一般的应用系统可以不要外扩存储器,可以极大地简化外围电路设计,降低系统成本和系统复杂度,也大大提高了数据的存储处理能力。
FPGA是在PAL、GAL、EPLD等可编程器件的基础上进一步发展的产物,FPGA使得用户可以根据自己的设计需要,通过特定的布局布线工具对其内部进行重新组合连接,在最短的时间内设计出自己的专用集成电路,这样就减小成本、缩短开发周期。由于FPGA采用软件化的设计思想实现硬件电路的设计,这样就使得基于FPGA设计的系统具有良好的可复用和修改性,这种全新的设计思想已经逐渐应用在高性能的交、直流驱动控制上,并快速发展。它是作为专用集成电路(ASIC)领域中的一种半定制电路而出现的,即解决了定制电路的不足,又克服了原有可编程器件门电路数有限的缺点,可以说,FPGA芯片是小批量系统提高系统集成度、可靠性的最佳选择之一。综合本发明的需要,选用FPGA作为多轴直流无刷伺服电机的伺服控制调节器,把TMS320F2812从复杂的多轴伺服控制算法中解脱出来。
为了能够更好的移动病床,发明的机器人电动病床驱动部分采用轮式结构,因为相对于步行、爬行或其它非轮式的移动机器人,轮式机器人具有行动快捷、工作效率高、结构简单、可控性强、安全性好等优势。
由于本机器人电动病床既要考虑其运行速度,又要考虑其运行方向,只有二者之间能够实现解耦,就可以在病房内自由移动,因此,需要两个电机来完成这个动作,单轮驱动可以很好的实现速度大小和方向的解耦,因此单轮驱动是一个不错的选择。由于直流电机在高速旋转时偶尔会产生火花,而医院病房又是一个特殊的场合,任何火花都可能会对病人的氧气瓶和吸氧装置产生潜在的危险,因此,本发明中的行走驱动电机和负责转向的电机均采用直流无刷伺服电机,由于采用霍尔传感器进行电子换向,有效消除了安全隐患。
由于本发明中的机器人电动病床既要适应病房中相对干净的环境,又要适应病房外相对灰尘较多的肮脏环境,为了减少灰尘对电机携带速度和位移传感器的影响,本发明舍弃了传统系统中常用的光电编码器,而采用基于磁电传感器AS5040H的编码器,磁电编码器可以有效测量出两轴直流无刷伺服电机运动时的速度和位移,为机器人电动病床两轴三闭环伺服控制提供了可靠反馈。
本实施例中,所述的传感器包括加速度计和陀螺仪;所述的第一控制信号和第二控制信号均为PWM波控制信号。
加速度计传感器在较长时间的测量值(确定机器人电动病床航向)是正确的,而在较短时间内由于信号噪声的存在,而有一定误差。陀螺仪在较短时间内则比较准确,而较长时间则会随着漂移的存在而产生一定误差,因此,需要加速度计和陀螺仪相互调整来确保航向的正确。为了提高机器人电动病床在行走过程中导航的稳定性,实现姿态的自动精确调整以及计算加速爬坡时需要的功率,本发明在机器人电动病床伺服硬件系统中加入了三轴加速度计和三轴陀螺仪。在机器人电动病床行走期间全程开启加速度计和陀螺仪,加速度计和用来测量机器人病床三个前进方向的加速度和速度,控制器根据测量值然后通过积分就可以得到其位移,为机器人的三闭环控制提供可靠判据;当机器人病床的姿态发生变化时,控制器就可以得到其大致倾斜角度,一方面根据角度改变其功率需求,另一方面当姿态发生较大变化时,控制器在一个新的采样周期立即对其位置补偿,避免机器人电动病床在行走过程中因为倾斜过大而发生危险,提高了其快速行走导航时的稳定性;如果对加速度计和陀螺仪的值进行连续积分和匹配,且把它变换到导航坐标系中,机器人电动病床可以不依赖于任何外部信息就能够得到其在医院导航坐标系中的加速度、速度、偏航角和位置等信息,所产生的导航信息连续性好而且噪声非常低,可以和磁电编码器传感器相互匹配然后为多轴伺服控制提供加速度、速度和位移反馈,极大增强了机器人病床的行走的安全性和准确性。
本发明为克服普通医院病床不能满足病人实际要求,在吸收国外先进控制思想的前提下,自主研发了一款基于DSP(TMS320F2812)+FPGA(A3P250)的全新双核单轮驱动机器人电动病床。此机器人控制系统以FPGA(A3P250)为处理核心,实现两轴直流无刷电机的同步伺服控制,TMS320F2812实现多种传感器信号的数字信号实时处理,并实时相应各种中断保护请求,并实现与FPGA(A3P250)数据通信。
如图2所示,所述的双核单轮驱动高速机器人电动病床控制器还设置有人机界面程序和运动控制系统,所述的人机界面程序包括人机界面、路径规划以及在线输出,所述的运动控制系统包括基于FPGA两轴直流无刷电机伺服控制、数据存储以及I/O控制,其中,所述的基于FPGA两轴直流无刷电机伺服控制包括DA模块、磁电编码器模块、加速度计和陀螺仪加速度模块、基于磁电传感器速度模块以及基于磁电传感器位移模块。
为达上述目的,本发明采取以下技术方案, 为了提高运算速度,保证医用机器人电动病床控制系统的稳定性和可靠性,本发明采用32位高性能DSP(TMS320F2812)和FPGA,舍弃了传统采用的单一单片机或单一16位的DSP芯片,此控制器充分考虑蓄电池在这个系统的作用,实现单一控制器同步控制两轴直流无刷伺服电机的功能。机器人电动病床充分发挥FPGA处理速度较快的特点,而由TMS320F2812实现人机界面、I/O控制、路径导航、在线输出、数据采集与存储等功能,同时实时相应各种中断。
对于本文设计的基于DSP(TMS320F2812)+ FPGA机器人电动病床控制器,在电源打开状态下,人机界面先工作,如果确实需要移动电动病床,护工人员、护士人员输入各自的权限密码,DSP(TMS320F2812)使能FPGA机器人电动病床才可能在屋子里移动,否则机器人电动病床就待在原地等待权限开启命令;如果机器人电动病床需要推出病房,此时医院负责人需要开启自己的权限密码,否则机器人电动病床一旦移动到门口位置被门口监控传感器探测到,检测系统会触发控制器上的传感器,FPGA锁死当前的机器人电动病床并通过TMS320F2812发出误操作警报。在正常运动状态下,机器人电动病床通过各种传感器读取外部环境并反馈参数给FPGA,由FPGA处理后直接生成两轴直流无刷伺服电机的同步控制PWM信号,PWM波信号经驱动放大后驱动直流无刷电机X和直流无刷电机Y向前运动,其运动速度和位移被相对应的磁电编码器M1和M2反馈给FPGA,由FPGA二次调整同步PWM控制信号满足实际工作需求。电动床在运行过程中,基于DSP的人机界面在线存储并输出当前状态,使得处理比较直观。
参照图2,具体实施步骤是:
把医用电动床控制系统分为两部分:人机界面系统和运动控制系统。其中人机界面系统完成人机界面、路径规划、在线输出等功能;基于FPGA运动控制系统完成电动病床的多轴伺服控制,而DSP实现数据存储、I/O控制等功能,系统充分发挥FPGA处理数据较快的优点,同时由DSP实时处理和存储各种数据。
参照图2、图3和图4,其具体的功能实现如下:
1)在机器人电动病床未接到任何指令之前,它一般会和普通医用病床没有区别,被固定在某一个区域,交流电源对系统中的蓄电池充电,保证机器人电动病床有足够的能源完成任务;
2)一旦接到主控器发出的工作命令后,为了防止机器人电动病床的移动损害充电连接线,DSP控制器会自动断开连接线与交流电源的连接,机器人电动病床转为蓄电池供电状态;
3)为了防止误操作,本发明采用三级启动权限,当确定需要移动机器人电动病床时,如果只是在病房内部移动机器人电动病床,则需要护工人员和护士先后通过人机界面输入权限密码开启屋内行走模式;如果是需要推动机器人电动病床走出病房,则需要护工人员、护士和医院负责人先后通过人机界面输入权限密码开启屋外行走模式;
4)当机器人电动病床开启行走模式后,一旦启动键SS按下,系统首先完成DSP和FPGA的初始化并检测电源电压,如果蓄电池电源不正常,将向DSP和FPGA发出中断请求,DSP和FPGA会对中断做第一时间响应,如果FPGA的中断响应没有来得及处理,机器人电动病床上的自锁装置将被触发,进而达到自锁的功能,防止误操作;如果电源正常,机器人电动病床将开始正常工作;
5)当FPGA控制器检测到启动键SS按下,FPGA控制器将检测侧向转弯按钮SK是否被触发,如果侧向转弯按钮SK被触发,FPGA根据机器人电动病床运动部分需要旋转角度和其内部伺服控制程序,把直流无刷伺服电机Y要运转的距离SX转化为加速度、速度和位置参考指令值,然后再结合直流无刷伺服电机Y对应的磁电传感器的反馈生成驱动直流无刷伺服电机Y的驱动信号,驱动信号经功率桥放大后驱动直流无刷伺服电机Y运动,由于直流无刷电机Y在旋转过程中通过齿轮结构带动直流无刷伺服电机X运动,当直流无刷伺服电机Y完成这次伺服运动,直流无刷伺服电机X已经完成侧转的任务,由于在此过程中只是电机Y驱动电机X旋转90度,并为改变电动病床的方向,提高了机器人电动病床在狭小空间的实用性。在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
6)当FPGA控制器检测到启动键SS按下,如果此时只有前进按钮SF被触发,机器人电动病床将开始向前运动,在运动过程中,机器人电动病床携带的前方防撞超声波传感器S9和S10将工作,并向FPGA和DSP双核控制器时刻反馈其与前方障碍物的距离,如果防撞超声波传感器S9或者是S10读取到前方有障碍物时,FPGA经内部伺服控制程序调整直流无刷伺服电机X的PWM输出,控制机器人电动病床在安全范围内停车,停车后控制器并开启一个三秒的计时,如果三秒后控制器依旧读取到障碍物则通知人机界面改换行走轨迹;如果三秒后障碍物信号消息,则机器人电动病床将按照当前路径继续启动前进。在机器人电动病床运动过程中,磁电传感器会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移反馈给FPGA,由FPGA根据位移、速度和加速度偏差信号二次调整电机X和电机Y的控制信号,在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
7)当FPGA控制器检测到启动键SS按下,如果此时只有后退按钮SB也被触发,机器人电动病床将开始后退运动,FPGA经内部伺服控制程序调整直流无刷伺服电机X和Y的PWM输出,控制机器人电动病床按照设定速度缓慢后退;在后退运动过程中,磁电传感器会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移并反馈给FPGA,由FPGA根据位移、速度和加速度偏差信号二次调整电机X和电机Y的控制信号,保证机器人电动病床在安全速度范围内运行,防止速度过快机器人电动病床推倒护工人员,在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
8)当FPGA控制器检测到启动键SS按下,如果此时转弯按钮SK和前进按钮SF被触发,机器人电动病床将开始侧向右移,在运动过程中,机器人电动病床携带的侧方防撞超声波传感器S6将工作,并向FPGA和TMS320F2812双核控制器时刻反馈其与前方障碍物的距离,如果防撞超声波传感器S6读取到右方有障碍物时,FPGA经内部伺服控制程序调整直流无刷伺服电机X的PWM输出,控制机器人电动病床在安全范围内停车,控制器并开启一个三秒的计时,如果三秒后控制器依旧读取到障碍物存在将向人机界面发出停车报警;如果三秒后障碍物信号消息,则机器人电动病床将按照当前轨迹继续侧向右移,在机器人电动病床侧向右移过程中,磁电传感器会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移,并反馈给FPGA,由FPGA根据位移、速度和加速度偏差信号二次调整电机X和电机Y的控制信号。在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
9)当FPGA控制器检测到启动键SS一旦按下,如果此时转弯按钮SK和前进按钮SB被触发,机器人电动病床将开始侧向左移,在运动过程中,机器人携带的侧方防撞超声波传感器S7将工作,并向FPGA和DSP双核控制器时刻反馈其与前方障碍物的距离,如果防撞超声波传感器S7读取到左方有障碍物时,FPGA经内部伺服控制程序调整直流无刷伺服电机X的PWM输出,控制机器人电动病床在安全范围内停车,控制器并开启一个三秒的计时,如果三秒后控制器依旧读取到障碍物存在将向人机界面发出停车报警;如果三秒后障碍物信号消息,则机器人电动病床将按照当前轨迹继续侧向左移,在机器人电动病床侧向左移过程中,磁电传感器会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移,并反馈给FPGA,由FPGA二次调整电机X和电机Y的运动参数,在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
10)当机器人电动病床需要移出病房时,现有医院负责人开启行走权限密码,然后护工人员把机器人电动病床推到带有地面标志的位置,机器人电动病床进入自动导航状态:其导航的光电传感器S1、S2、S3、S4、S5将工作,地面标志反射回来的光电信号反馈给FPGA,经FPGA判断处理后确定机器人偏移导航轨道的偏差,FPGA结合内部梯形发生器把此偏差信号转化为电机X和电机Y要运行的加速度、速度和位移指令,再结合磁电编码器的反馈生产驱动直流无刷伺服电机X和电机Y的驱动信号,驱动信号放大后驱动直流无刷电机X和电机Y向前运动,快速调整机器人电动病床迅速回到导航轨道中心,机器人电动病床沿着轨道行走过程,FPGA根据地面标志和磁电编码器的反馈微调电机X和电机Y的驱动信号,使机器人沿着设定好的轨道顺利通过病房门口,当铺设的轨道消失后,机器人电动病床就停在原地等待人为推动信号,防止误操作,在运动过程中,FPGA根据外界情况实时调整伺服控制程序的PID参数以满足实际需要,DSP实时记录电动病床的运行参数并在人机界面显示;
11)本机器人电动病床在运动过程为了防止护士的误操作以及遇到紧急状况停车,加入了紧急停车自动锁车功能,如遇到紧急情况,当紧急按键ESW1按下后,控制器一旦检测到紧急中断请求会发出原地停车指令并通过TMS320F2812发出警报,FPGA通过驱动器锁死行走电机X,即使电动病床多个万向轮W都处于可以滑动状态,由于行走电机X处于锁死状态,这样机器人电动病床也不会运动;
12)本发明在机器人电动病床上加入了湿度检测系统。此湿度检测系统由湿敏传感器、测量电路和显示记录装置等几部分组成,分别完成信息获取、转换、显示和处理等功能,这样当病人大小便失控时,湿度检测系统会工作,将发出报警信号,护工人员通过人机界面输出可以查出故障原因,然后更换床褥;
13)本电动床装备了多种防障碍物报警系统,床载障碍探侧系统可以在碰撞到障碍物之前自动探测到障碍物的存在并自动停车,并根据障碍物的性质确定二次启动或是一直待在原地不动,这样就保证了在运动过程中对周围环境的适应,减少了环境对其的干扰;
14)在机器人电动病床行走过程中,电机经常会收到外界因素干扰,为了减少电机的脉动转矩对机器人行走的影响,控制器在考虑电机特性的基础上加入了对电机转矩的在线辨识,并利用电机力矩与电流的关系进行补偿,削弱了外界环境对机器人运动的影响;
15)在机器人电动病床行走期间伺服控制器全程开启加速度计和陀螺仪,加速度计和陀螺仪可以精确测量出机器人病床三个前进方向的加速度,根据测得的加速度和速度控制器通过连续积分就可以得到其位移,为机器人的三闭环控制提供可靠判据;同时当机器人病床的姿态发生变化时,控制器就可以得到其大致倾斜角度和加速度要求,控制器根据倾斜角度和加速度需求就可以大致计算出功率需求,然后调整各台直流无刷伺服电机的功率以满足爬坡和加速需要;控制器通过对加速度计和陀螺仪进行连续积分,且把它变换到医院导航坐标系中,机器人电动病床可以不依赖于任何外部信息就能够得到其在医院导航坐标系中的加速度、速度、偏航角和位置等信息,控制器实时进行存储和显示。
本发明具有的有益效果是:
1:在控制过程中,充分考虑了电池在这个系统中的作用,基于DSP(TMS320F2812)+FPGA控制器时刻都在对机器人电动病床的运行状态和电源来源进行监测和运算,当交流电源切断时,病床会自动借助自带蓄电池电源自动锁死在固定位置,直至有移动开关信号输入,保证了病床的自然状态。
2:为了方便病人自理,减少对外界条件的依赖,本系统加入了人机界面功能,病人只要通过电脑触摸屏就可以自动控制病床机器人,这样就可以不需要护理而自己解决部分简易的日常生活。
3:由于此电动病床加入了基于蓄电池的动力助力装置,即使碰到病人身体肥胖或者护理人员身体瘦弱时,病床本身在电源充足的条件下可以为护工人员和护士人员在屋子里移动病床提供动力,减少了护士或者护工人员在屋子里移动病床的体力消耗和劳动强度。
4:由于此电动病床加入了基于直流无刷伺服电机的单轮驱动系统,使得病床可以在屋子里实现自由移动,减少了病人在某一个固定位置的压抑感。
5:由于此电动病床加入了基于直流无刷伺服电机的单轮驱动系统,使得电动病床可以在屋子里原地按照任意方向自由旋转,减少了移动病床需要的空间,特别适合应用于空间狭小的病房。
6:由于加入了基于直流无刷伺服电机的单轮驱动系统,在非常狭小的空间内可以使病床机器人侧向移动,减少机器人旋转带来的负面问题。
7:为了能够使病床机器人能够自由移出病房门口,控制器加入了多种导航传感器,机器人在移出病房过程中一旦读到地面标志就会自动导航,减少人工移动病床带来的误差。
8:当机器人电动病床遇到爬坡的时,由于自身携带的有动力能源,所以可以很好的起到助力作用,减少了对护工人员体力的要求。
9:由FPGA处理多轴直流无刷伺服电机的全数字伺服控制,大大提高了运算速度,解决了单单片机运行较慢的瓶颈,缩短了开发周期短,并且程序可移植能力强。
10:本发明完全实现了单板控制,不仅节省了控制板占用空间,而且还完全实现了多轴直流无刷伺服电机控制信号的同步,有利于提高机器人电动病床的稳定性和动态性能。
11:由于本控制器采用FPGA处理大量的多轴伺服数据与算法,并充分考虑了周围的干扰源,把TMS320F2812从复杂的计算中解脱出来,有效地防止了程序的“跑飞”,抗干扰能力大大增强。
12:本机器人电动病床加入了自动锁车功能,当病床机器人在移动过程中,如遇到紧急情况,FPGA控制器会发出原地停车指令,并锁死主运动电机,即使多个万向轮都处于可以滑动状态,但由于驱动轮处于锁死状态,机器人也不能运动。
13:本发明在机器人电动病床系统中加入了多种开启权限,防止了病床的误操作。
14:本机器人电动病床加入了湿度检测系统。此湿度检测系统由湿敏传感器、测量电路和显示记录装置等几部分组成,分别完成信息获取、转换、显示和处理等功能,这样当病人大小便失控或者是床单潮湿时,湿度检测系统会工作,发出更换请求。
15:本电动床机器人装备了多种报警系统,在碰撞到障碍物之前自动停车,这样就保证了在运动过程中的安全性,减少了环境对其的干扰。
16:由于本机器人电动病床系统采用直流无刷伺服电机替代了直流电机,不仅进一步提高了系统的安全性,也可以提高能源的利用率,增加了机器人电动病床在携带能源一定的条件下一次移动的距离。
17:由于本机器人电动病床系统采用直流无刷伺服电机,当电机受到外界干扰产生脉动转矩时,直流无刷伺服电机可以利用力矩与电流的关系迅速进行补偿,极大减少了外界干扰对机器人电动病床的影响。
18:由于由FPGA直接生产多轴直流无刷电机驱动信号,不需要DSP向其输入任何参数,使得系统的处理速度加快,有利于系统高速运行。
19:FPGA控制器根据外围环境实时调整伺服控制系统的PID参数,满足电动病床不同状况下快速伺服控制系统调整的要求。
20:加速度计和陀螺仪用来测量机器人病床三个前进方向的加速度和速度,根据测量值控制器通过连续积分就可以得到其速度和位移,为机器人的三闭环控制提供可靠判据;
21:加速度计和陀螺仪可以提高机器人电动病床在行走过程中导航的稳定性,实现姿态的自动精确调整、计算加速爬坡时需要的功率。
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书内容所作的等效结构或等效流程变换,或直接或间接运用在其它相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (7)
1.一种双核单轮驱动高速机器人电动病床控制器,其特征在于,包括交流电源、电池、控制板、第一电机、第二电机以及机器人电动病床,所述的交流电源和电池提供电流驱动所述的控制板,所述的控制板采用双核控制器,包括DSP和FPGA,所述的DSP和FPGA进行通信连接,所述的机器人电动病床上设有传感器,所述的FPGA接受传感器反馈的传感器信号,由所述的FPGA发出第一控制信号和第二控制信号,所述的第一控制信号和第二控制信号经驱动放大后驱动所述的第一电机和第二电机,所述的第一电机和第二电机上设置有磁电编码器,通过磁电编码器由所述的第一电机和第二电机控制所述的机器人电动病床的前进、运行速度和运行方向。
2.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的电池采用锂离子电池。
3.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的第一电机和第二电机均采用高速直流无刷伺服电机。
4.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的DSP采用TMS320F2812;所述的FPGA采用A3P250。
5.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的传感器包括加速度计和陀螺仪。
6.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的第一控制信号和第二控制信号均为PWM波控制信号。
7.根据权利要求1所述的双核单轮驱动高速机器人电动病床控制器,其特征在于,所述的双核单轮驱动高速机器人电动病床控制器还设置有人机界面程序和运动控制系统,所述的人机界面程序包括人机界面、路径规划以及在线输出,所述的运动控制系统包括基于FPGA两轴直流无刷电机伺服控制、数据存储以及I/O控制,其中,所述的基于FPGA两轴直流无刷电机伺服控制包括DA模块、磁电编码器模块、加速度计和陀螺仪加速度模块、基于磁电传感器速度模块以及基于磁电传感器位移模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610600752.0A CN106667684A (zh) | 2016-07-28 | 2016-07-28 | 一种双核单轮驱动高速机器人电动病床控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610600752.0A CN106667684A (zh) | 2016-07-28 | 2016-07-28 | 一种双核单轮驱动高速机器人电动病床控制器 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106667684A true CN106667684A (zh) | 2017-05-17 |
Family
ID=58839795
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610600752.0A Pending CN106667684A (zh) | 2016-07-28 | 2016-07-28 | 一种双核单轮驱动高速机器人电动病床控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106667684A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111438693A (zh) * | 2020-05-15 | 2020-07-24 | 深圳国信泰富科技有限公司 | 一种机器人控制系统及机器人 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004222851A (ja) * | 2003-01-21 | 2004-08-12 | Mitsubishi Automob Eng Co Ltd | 自走式医療用ベッド |
CN101304716A (zh) * | 2005-11-10 | 2008-11-12 | 林内特斯波尔有限公司 | 医院病床的底架 |
CN102824255A (zh) * | 2012-09-17 | 2012-12-19 | 苏州工业园区职业技术学院 | 一种双核医用电动床控制器 |
CN105159325A (zh) * | 2015-08-24 | 2015-12-16 | 铜陵学院 | 一种基于stm32f407和fpga两轮高速灭火机器人伺服控制器 |
CN105769474A (zh) * | 2016-03-18 | 2016-07-20 | 薄和秋 | 一种全自动智能护理床及闭环控制系统 |
-
2016
- 2016-07-28 CN CN201610600752.0A patent/CN106667684A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004222851A (ja) * | 2003-01-21 | 2004-08-12 | Mitsubishi Automob Eng Co Ltd | 自走式医療用ベッド |
CN101304716A (zh) * | 2005-11-10 | 2008-11-12 | 林内特斯波尔有限公司 | 医院病床的底架 |
CN102824255A (zh) * | 2012-09-17 | 2012-12-19 | 苏州工业园区职业技术学院 | 一种双核医用电动床控制器 |
CN105159325A (zh) * | 2015-08-24 | 2015-12-16 | 铜陵学院 | 一种基于stm32f407和fpga两轮高速灭火机器人伺服控制器 |
CN105769474A (zh) * | 2016-03-18 | 2016-07-20 | 薄和秋 | 一种全自动智能护理床及闭环控制系统 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111438693A (zh) * | 2020-05-15 | 2020-07-24 | 深圳国信泰富科技有限公司 | 一种机器人控制系统及机器人 |
CN111438693B (zh) * | 2020-05-15 | 2022-05-31 | 深圳国信泰富科技有限公司 | 一种机器人控制系统及机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108272565A (zh) | 智能安全轮椅及其智能安全控制方法 | |
CN105997396A (zh) | 一种双核三轮驱动自由升降高速机器人电动病床控制器 | |
WO2020037975A1 (zh) | 一种扫地机器人的防碰撞检测方法 | |
CN101592947B (zh) | 一种Zigbee接入的电动轮椅控制器及控制方法 | |
WO2010088251A1 (en) | Secondary position feedback control of a robot | |
CN104876127A (zh) | 一种桥、门式起重机大小车运行位姿监测装置及方法 | |
CN105997392A (zh) | 一种无线双核双轮驱动机器人电动病床控制系统 | |
CN106074049A (zh) | 一种双核单轮驱动自由升降高速机器人电动病床控制器 | |
CN106667684A (zh) | 一种双核单轮驱动高速机器人电动病床控制器 | |
CN106137605A (zh) | 一种无线双核三轮驱动机器人电动病床控制系统 | |
CN106020069A (zh) | 一种无线双核双轮驱动高速机器人电动病床控制器 | |
CN106074040A (zh) | 一种无线双核三轮自由升降高速机器人电动病床控制器 | |
CN106176093A (zh) | 一种无线单核单轮两轴多功能电动病床 | |
CN106074044A (zh) | 一种无线双核单轮驱动高速机器人电动病床控制器 | |
CN106137604A (zh) | 一种双核双轮驱动高速机器人电动病床控制器 | |
CN106074041A (zh) | 一种无线单核单轮驱动多功能电动病床 | |
CN106074035A (zh) | 一种双核双轮驱动机器人电动病床控制系统 | |
CN106074047A (zh) | 一种无线双核单轮驱动机器人电动病床控制系统 | |
CN106074046A (zh) | 一种三核三轮驱动自由升降机器人电动病床控制器 | |
CN106176094A (zh) | 一种无线双核单轮驱动自由升降机器人电动病床控制器 | |
CN106137620A (zh) | 一种无线双核双轮自由升降机高速器人电动病床控制器 | |
CN106094617A (zh) | 无线传输三核八轴履带式高速天然气管道机器人控制系统 | |
CN106137613A (zh) | 一种双核单轮驱动自由升降机器人电动病床控制器 | |
CN106074048A (zh) | 一种双核三轮驱动高速机器人电动病床控制器 | |
CN106137617A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170517 |