CN106074045A - 一种双核双轮驱动自由升降机器人电动病床控制器 - Google Patents

Abstract

本发明公开了一种双核双轮驱动自由升降机器人电动病床控制器，包括交流电源、电池、控制板、电机X、电机Y、电机Z以及电机R，所述的控制板采用双核控制器，包括ARM和MC2340，通过磁电编码器由所述的电机X、电机Y、电机Z和电机R控制所述的机器人电动病床的前进、运行速度、运行方向和升降运动。通过上述方式，本发明既能通过控制器改变其行走速度，又可以通过两轮差速行驶方式改变其方向，可以很好的通过电动助力减少护工或者护士人员的劳动量和劳动强度；同时在电动病床的头部和尾部均加入一轴电动升降装置，起到自由升降病人身体头部、腰部和腿部的功能，可以满足不同条件下病人对病床的需求。

Description

一种双核双轮驱动自由升降机器人电动病床控制器

技术领域

本发明涉及一种双核双轮驱动、可以自由升降的机器人电动病床自动控制系统，属于自动电动病床领域。

背景技术

医用病床系统是一种用于医院病房内提供承载患者的设备。目前发达国家医院中使用的医用病床基本上全部自动化，家庭病床、社区医院病床也已经使用多功能电动床。部分医用病床可以通过外力改变形状达到辅助调整患者体位的目的，其中有些附件具有促进患者康复的效果；可控制电动病床是相对高级的自动化产品，具有省时省力的优点。由于电控制的特点，控制键可以安装在任何允许病床接受到信号的范围内，提高了控制的自由度。通过附件升级，还可以实现权限分配。电动驱动产品精度更高，便于流水线作业，已作为ICU重症监护室、手术室、造影室等中使用的特种医用病床。

我国在医用电动病床领域的研究开发相对滞后，整体水平不高，现国内各级医院均是采用普通的机械病床：由床腿、床体和床面组成。为了移动方便移动，一般均在床腿上设置机械滚动滑轮；为了方便病人坐起，均在床头部分设置机械手动摇起装置。对于这类型病床，一般均需要护理人员帮助，很难独自完成，同时病床功能单一，实用性能不强。

长时间运行发现存在着很多安全隐患和不便，即：

（1）现有的部分病床通过四个固定站脚与地面接触起到支撑作用，病人均被固定在某一个封闭的环境中，随着病人长时间的住院，对病人的身心造成了极大的伤害；

（2）虽然部分病床把固定站脚改为了机械万向轮，可以通过医护人员移动病床到某个空间，但是由于病床移动随意性较大，有时候会出现误操作，甚至有时候会伤害到病人；

（3）随着现代人类生活质量的增加，肥胖病人大量增加，而护士人员一般又都比较瘦小，通过机械万向轮移动病人使得护士人员非常吃力，加重了劳动强度；

（4）随着老龄化的加重，大量的老人也加重了对病床的需求，现在的护工人员又比较少，基于机械万向轮的病床加重了护工人员的劳动强度；

（5）所有的机械病床一般均固定在某个位置，一旦需要移动或者变换方向均需要外部人员完成，加重了护工人员的劳动量；

（6）现在的机械病床即使可以通过外力通过病房门口被推到外部环境中，由于人为操作的自动化程度比较低，通过病房门口都需要点时间调整病床的姿态才可以通过；

（7）现在的机械病床即使可以通过机械万向轮的支撑到达病房以外的环境，在调节了病人身心的同时，也加大了护工人员的劳动量，特别是通过爬坡的地方时，对护工人员的体力提出了更高的要求；

（8）虽然单轮驱动的电动病床可以很好的满足对病床速度和方向的解耦，但是单轮驱动的行走电机功率较大，有时候会造成大马拉小车的现象出现；

（9）由于单轮驱动的电动病床动力与地面的接触点只有一个，造成人为很难精确控制其移动的方向，轻微的一点干扰就能造成较大的方向改变；

（10）现有的机械病床一般均在病床的头部设置了一个摇动杠杠，当病人需要抬起头部或者是需要仰起上半身时，均有护理人员摇动杠杠达到升起部分病床的目的，病床的自动化程度较低，而且加重了护理人员的劳动量；

（11）现有的机械病床一般均没有考虑病人腿部的要求，病人的腿部位置的病床机械部分不能上下移动，对于长时间卧床的病人来说造成腿部肌肉萎缩等状况发生，不利于病人的病情治疗；

（12）现有的机械病床或简易的电动病床在推离病人离开病房时，不论病人的病情和状况如何，病人均是直直的躺在病床上，没有人性化考虑，有时对病人的心理伤害非常严重；

（13）基于单核控制的机器人电动病床，由于既要处理多轴电机的伺服控制，又要处理机器人病床的多种传感器采样数据，由于单核处理器处理的数据较多，运算速度不是很快，不利于机器人高速运转，且有时候由于处理数据较多导致机器人病床失控；

（14）由于机器人电动病床在运行过程中频繁的刹车和启动，加重了单核控制器的工作量，单核控制器无法满足机器人电动病床快速启动和停止的要求；

（15）由于受周围环境不稳定因素干扰，单核机器人电动病床控制器经常会出现异常，引起机器人病床在行驶过程中失控，抗干扰能力较差。

发明内容

本发明主要解决的技术问题是提供一种双核双轮驱动自由升降机器人电动病床控制器，为克服普通医院病床不能满足病人实际要求，在吸收国外先进控制思想的前提下，自主研发了一款基于ARM（STM32F407）+专用运动控制芯片MC2340的两轮差速驱动、两轴自由升降的四轴机器人电动病床。此机器人控制系统以MC2340为处理核心，实现四轴直流无刷电机的同步伺服控制，STM32F407实现多种传感器信号的数字信号实时处理，并实时相应各种中断保护请求，并实现与MC2340数据通信。

为解决上述技术问题，本发明采用的一个技术方案是：提供了一种双核双轮驱动自由升降机器人电动病床控制器，包括交流电源、电池、控制板、电机X、电机Y、电机Z以及电机R，所述的交流电源和电池提供电流驱动所述的控制板，所述的控制板采用双核控制器，包括ARM和MC2340，所述的ARM和MC2340进行通信连接，由所述的MC2340发出第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号，所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号经驱动放大后分别驱动所述的电机X、电机Y、电机Z和电机R，所述的电机X、电机Y、电机Z、和电机R上设置有磁电编码器，通过磁电编码器由所述的电机X、电机Y、电机Z和电机R控制所述的机器人电动病床的前进、运行速度、运行方向和升降运动。

在本发明一个较佳实施例中，所述的电池采用锂离子电池。

在本发明一个较佳实施例中，所述的电机X、电机Y、电机Z和电机R均采用直流无刷伺服电机。

在本发明一个较佳实施例中，所述的ARM采用STM32F407。

在本发明一个较佳实施例中，所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号均为PWM波驱动信号。

在本发明一个较佳实施例中，所述的双核双轮驱动自由升降机器人电动病床控制器还包括加速度计和陀螺仪，所述的加速度计和陀螺仪设置在机器人电动病床上。

在本发明一个较佳实施例中，所述的双核双轮驱动自由升降机器人电动病床控制器还设置有人机界面程序和运动控制系统，所述的人机界面程序包括人机界面、区域规划以及在线输出，所述的运动控制系统包括基于MC2340四轴直流无刷电机伺服控制、数据存储以及I/O控制，所述的基于MC2340四轴直流无刷电机伺服控制包括基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制，其中，基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制均包括磁电编码器模块、基于磁电编码器加速度模块、基于磁电编码器速度模块以及基于磁电编码器位移模块。

本发明的有益效果是：本发明的双核双轮驱动自由升降机器人电动病床控制器，设计了一款基于伺服专用控制芯片MC2340的双核两轮驱动、两轴自由升降病床的四轴机器人电动病床，这种病床既能通过控制器改变其行走速度，又可以通过两轮差速行驶方式改变其方向，可以很好的通过电动助力减少护工或者护士人员的劳动量和劳动强度；同时在电动病床的头部和尾部均加入一轴电动升降装置，起到自由升降病人身体头部、腰部和腿部的功能；多种传感器组合使得机器人电动病床具有多种功能，可以满足不同条件下病人对病床的需求。

附图说明

为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图，其中：

图1为本发明基于STM32F407+MC2340的双轮驱动、自由升降四轴医用病床原理图；

图2为本发明基于双核双轮驱动、自由升降四轴机器人电动病床程序框图；

图3为双核双轮驱动自由升降四轴机器人电动病床运动原理框图；

图4为双核双轮驱动自由升降四轴机器人电动病床通过病房门口自动导航原理图。

具体实施方式

下面将对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。

如图1所示，本实施例包括：

一种双核双轮驱动自由升降机器人电动病床控制器，包括交流电源、电池、控制板、电机X、电机Y、电机Z以及电机R，所述的交流电源和电池提供电流驱动所述的控制板，所述的控制板采用双核控制器，包括DSP和MC2340，所述的DSP和MC2340进行通信连接，由所述的MC2340发出第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号，所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号经驱动放大后分别驱动所述的电机X、电机Y、电机Z和电机R，所述的电机X、电机Y、电机Z、和电机R上设置有磁电编码器，通过磁电编码器由所述的电机X、电机Y、电机Z和电机R控制所述的机器人电动病床的前进、运行速度、运行方向和升降运动。

本实施例中，所述的电池采用锂离子电池；所述的电机X、电机Y、电机Z和电机R均采用直流无刷伺服电机。

进一步的，所述的ARM采用STM32F407。

STM32F4系列除引脚和软件兼容高性能的F2系列外，F4的主频(168MHz)高于F2系列(120MHz)，并支持单周期DSP指令和浮点单元、更大的SRAM容量(192 KB，F2为128 KB)、512KB-1MB的嵌入式闪存以及影像、网络接口和数据加密等更先进的外设。STM32F4系列基于最新的STM32F407 Cortex M4内核， 在现有出色的STM32微控制器产品组合中新增了信号处理功能，并提高了运行速度；STM32F405x集成了定时器、3个ADC、2个DAC、串行接口、外存接口、实时时钟、CRC计算单元和模拟真随机数发生器在内的整套先进外设。STM32F407在STM32F405产品基础上增加了多个先进外设。这些性能使得F4系列可以较容易满足控制和信号处理功能混合的数字信号控制需求。高效的信号处理功能与Cortex-M4处理器系列的低能耗、低成本和易于使用的优点的组合，使得STM32F407性能远远优越于一般的DSP芯片，并且STM32F407可以极大地简化外围电路设计，降低系统成本和系统复杂度，也大大提高了数据的存储处理能力。

美国PMD(Performance Motion Devices)运动控制芯片可以控制单轴和多轴无刷直流电机，它由一个主机通过下列方式驱动：8或者16位并行总线，CAN总线2.0B，或者一个异步串口。伺服环路补偿采用全32位位置误差、带速度和加速度前馈的PID、集成限幅和一对双边矩形滤波来对复杂负载做复杂控制。MC23XX系列运动控制芯片是PMD公司基于高性能运动控制开发的第三代伺服控制芯片，已经广泛应用于医疗、科学、自动化控制和机器人的应用。MC23XX可以实现直流无刷电机的位置、速度控制，同时芯片集成了过流保护，过压/欠压保护和过温保护等，芯片提供了一个灵活的和强大的指令集来初始化和设置和控制运动轴，并具有监视性能，MC2310、MC2320、MC2340分别可以控制一轴、两轴和四轴直流无刷电机，MC2320、MC2340加入了各轴电机同步的功能，这一点远远优越于LM629，MC23XX的这些特性使其特别适合直流无刷电机的控制。综合本发明的需要，选用MC2340作为伺服控制调节器，并通过串行口与STM32F407进行通讯和数据调用，把STM32F407从复杂的多轴伺服控制算法中解脱出来。

为了能够更好的移动机器人电动病床，本发明电动病床驱动部分采用轮式结构，因为相对于步行、爬行或其它非轮式的移动机器人，轮式机器人具有行动快捷、工作效率高、结构简单、可控性强、安全性好等优势。

由于本机器人电动病床既要考虑其运行速度，又要考虑其运行方向，因此，需要两个电机来完成这个动作，通过两轮差速行驶来实现速度和方向的调控是一种选择，并且两轮差速行驶的两个电机功率大小相等，而且功率加起来可以满足正常行驶时的功率要求，爬坡需要电动助力时可以通过两台电机短暂的过载满足。在正常行驶条件下，为了调整电动病床的行驶方向，通常改变两台电机的速度大小就可以随意实现方向的改变。由于直流电机在高速旋转时偶尔会产生火花，而医院病房又是一个特殊的场合，任何火花都可能会对病人的氧气瓶和吸氧装置产生潜在的危险，因此，本发明中负责机器人行走功能的两台差速行驶电机均采用直流无刷伺服电机，由于直流无刷伺服电机采用霍尔传感器进行电子换向，高速旋转不会产生任何火花，有效消除了安全隐患。

本发明为了能够使得机器人病床自动升降部分电动病床机械床体，达到升降病人的头部和腿部的功能，舍弃了传统机械病床采用人工摇动杠杠的方式，当病人需要抬起头部或者是需要仰起上半身时，基于单轴直流无刷伺服电机的头部伺服控制部分工作自动升降床体的头部；当病人需要抬起或者是下放腿部时，基于单轴直流无刷的腿部伺服控制部分工作自动升降床体的尾部；二者也可以同时工作，达到一起升降电动病床的功能；当病人需要休息时，只要按下恢复键，不论当前电动病床的姿态如何，床体均回到病床原始状态，满足病床的最小基本功能。

由于本发明中的机器人电动病床既要适应病房中相对干净的环境，又要适应病房外相对灰尘较多的肮脏环境，为了减少灰尘对电机携带速度和位移传感器的影响，本发明舍弃了传统系统中常用的光电编码器，而采用基于磁电传感器AS5040H的编码器M1、M2、M3和M4，传感器M1、M2、M3和M4可以有效测量出四轴直流无刷伺服电机运动时的速度和位移，为机器人电动病床四轴同步三闭环伺服控制提供了可靠反馈。

本实施例中，所述的传感器包括加速度计和陀螺仪；所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号均为PWM波驱动信号。

为了提高机器人电动病床在行走过程中导航的稳定性，实现姿态的自动精确调整以及计算加速爬坡时需要的功率，本发明在机器人电动病床伺服硬件系统中加入了三轴加速度计A1。在机器人电动病床行走期间全程开启加速度计A1，加速度计A1用来测量机器人病床三个前进方向的加速度，控制器根据测得的加速度通过连续积分就可以得到其速度和位移，可以为机器人的三闭环控制提供可靠判据；当机器人病床的姿态发生变化时，控制器就可以得到其大致倾斜角度，一方面根据角度改变其功率需求，另一方面当姿态发生较大变化时，控制器在一个新的采样周期立即对其位置补偿，避免机器人电动病床在行走过程中因为倾斜过大而发生危险，提高了其快速行走导航时的稳定性；如果对加速度计A1进行连续积分，且把它变换到导航坐标系中，机器人电动病床可以不依赖于任何外部信息就能够得到其在医院导航坐标系中的加速度、速度、偏航角和位置等信息，所产生的导航信息连续性好而且噪声非常低，可以和磁电传感器相互匹配然后为多轴伺服控制提供加速度、速度和位移反馈，极大增强了机器人病床的行走的安全性和准确性。

本发明为克服普通医院病床不能满足病人实际要求，在吸收国外先进控制思想的前提下，自主研发了一款基于ARM（STM32F407）+专用运动控制芯片MC2340的两轮差速驱动、两轴自由升降的四轴机器人电动病床。此机器人控制系统以MC2340为处理核心，实现四轴直流无刷电机的同步伺服控制，STM32F407实现多种传感器信号的数字信号实时处理，并实时相应各种中断保护请求，并实现与MC2340数据通信。

如图2所示，所述的双核双轮驱动自由升降机器人电动病床控制器还设置有人机界面程序和运动控制系统，所述的人机界面程序包括人机界面、区域规划以及在线输出，所述的运动控制系统包括基于MC2340四轴直流无刷电机伺服控制、数据存储以及I/O控制，所述的基于MC2340四轴直流无刷电机伺服控制包括基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制，其中，基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制均包括磁电编码器模块、基于磁电编码器加速度模块、基于磁电编码器速度模块以及基于磁电编码器位移模块。

为达上述目的，本发明采取以下技术方案， 为了提高运算速度，保证医用机器人电动病床控制系统的稳定性和可靠性，本发明采用32位高性能ARM （STM32F407）和专用运动控制芯片MC2340，舍弃了传统采用的单一单片机或单一16位的DSP芯片，此控制器充分考虑蓄电池在这个系统的作用，实现单一控制器同步控制四轴直流无刷伺服电机的功能。机器人电动病床充分发挥专用运动控制芯片MC2340作为伺服处理器数据处理速度较快的特点，而由STM32F407实现人机界面、I/O控制、路径导航、在线输出、数据采集与存储等功能，同时实时相应各种中断。

对于本文设计的基于ARM（STM32F407 ）+MC2340机器人电动病床控制器，在电源打开状态下，人机界面先工作，如果确实需要移动电动病床，护工人员、护士人员输入各自的权限密码，ARM（STM32F407）使能MC2340机器人电动病床才可能在屋子里移动，否则机器人电动病床就待在原地等待权限开启命令；如果机器人电动病床需要推出病房，此时医院负责人需要开启自己的权限密码，否则机器人电动病床一旦移动到门口位置被门口监控传感器探测到，检测系统会触发控制器上的传感器，MC2340锁死当前的机器人电动病床并发出误操作警报。在正常运动状态下，机器人电动病床通过各种传感器读取外部环境比反馈参数给ARM（STM32F407 ），由ARM（STM32F407 ）处理后与MC2340通讯，由MC2340生成四轴直流无刷伺服电机的同步控制PWM信号，PWM波信号经驱动放大后通过直流无刷电机Z和R完成头部和腿部病床部分的升降，然后通过直流无刷电机X、直流无刷电机Y两轮差速控制驱动病床向前运动，其运动速度和位移被相对应的磁电编码器M1、M2、M3、M4反馈给ARM（STM32F407），由ARM（STM32F407 ）处理后与MC2340通讯，由MC2340生成二次调整同步PWM控制信号满足实际工作需求。电动床在运行过程中，人机界面在线存储并输出当前状态，使得处理比较直观。

参照图2，具体实施步骤是：

把医用电动床控制系统分为两部分：人机界面系统和运动控制系统。其中人机界面系统完成人机界面、路径规划、在线输出等功能；基于MC2340运动控制系统完成电动病床的多轴伺服控制，而ARM（STM32F407 ）实现数据存储、I/O控制等功能，系统充分发挥MC2340伺服处理器的优点，同时由STM32F407实时处理各种传感器信号。

参照图2、图3和图4，其具体的功能实现如下：

1）在机器人电动病床未接到任何指令之前，它一般会和普通医用病床没有区别，被固定在某一个区域，交流电源对系统中的蓄电池充电，保证机器人电动病床有足够的能源完成任务。

2）一旦接到主控器发出的工作命令后，为了防止机器人电动病床的移动损害充电连接线，STM32F407 控制器会自动断开连接线与交流电源的连接，机器人电动病床转为蓄电池供电状态。

3）为了防止误操作，本发明采用三级启动权限，当确定需要移动机器人电动病床时，如果只是在病房内部移动机器人电动病床，则需要护工人员和护士先后通过人机界面输入权限密码开启屋内行走模式；如果是需要推动机器人电动病床走出病房，则需要护工人员、护士和医院负责人先后通过人机界面输入权限密码开启屋外行走模式。

4）当机器人电动病床开启行走模式后，一旦启动键SS按下，系统首先完成初始化并检测电源电压，如果蓄电池电源不正常，将向STM32F407 发出中断请求，STM32F407 会对中断做第一时间响应，如果STM32F407 的中断响应没有来得及处理，车体上的自锁装置将被触发，进而达到自锁的功能，防止误操作；如果电源正常，电动床机器人将开始正常工作。

5）当STM32F407控制器检测到启动键SS按下，如果此时只有头部上升按钮SHF被触发，机器人电动病床将开始做病床头部上升部分的运动，STM32F407根据伺服控制器的要求把按键每次需要运行的距离S转化为电机Z的加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，MC2340再结合电机Z对应的磁电传感器M3的速度和位移反馈生成驱动直流无刷伺服电机Z的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机Z正向运动，机器人电动病床开始缓缓升起，在运动过程中，一旦护理人员的手不在触发启动键或者是上升按钮SHF，直流无刷伺服电机Z的伺服控制就结束，完成此次上升过程；当病人的头部需要下降时，护理人员只要同时按下启动键SS和头部下降按钮SHB，机器人电动病床将开始做病床头部下降部分的运动，STM32F407根据伺服控制器的要求把按键每次需要运行的距离S转化为电机Z的加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，MC2340再结合电机Z对应的磁电传感器M3的速度和位移反馈生成驱动直流无刷伺服电机Z的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机Z反向运动，机器人电动病床开始缓缓下降，在运动过程中，一旦护理人员的手不在触发启动键或者是上升按钮SHB，直流无刷伺服电机Z的伺服控制就结束，完成此次下降过程。STM32F407伺服控制器记录下当前位置与水平位置的位移SHS。

6）当STM32F407控制器检测到启动键SS按下，如果此时只有腿部上升按钮SLF被触发，机器人电动病床将开始做病床腿部上升部分的运动，STM32F407根据伺服控制器的要求把按键每次需要运行的距离S转化为电机R的加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，MC2340再结合电机R对应的磁电传感器M4的速度和位移反馈生成驱动直流无刷伺服电机R的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机R正向运动，机器人电动病床开始缓缓升起，在运动过程中，一旦护理人员的手不在触发启动键或者是上升按钮SLF，直流无刷伺服电机R的伺服控制就结束，完成此次上升过程；当病人的腿部需要下降时，护理人员只要同时按下启动键SS和头部下降按钮SLB，机器人电动病床将开始做病床腿部下降部分的运动，STM32F407根据伺服控制器的要求把按键每次需要运行的距离S转化为电机R的加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，MC2340再结合电机R对应的磁电传感器M4的速度和位移反馈生成驱动直流无刷伺服电机R的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机R反向运动，机器人电动病床开始缓缓下降，在运动过程中，一旦护理人员的手不在触发启动键或者是上升按钮SLB，直流无刷伺服电机R的伺服控制就结束，完成此次下降过程。STM32F407伺服控制器记录下当前位置与水平位置的位移SLS。

7）当STM32F407控制器检测到启动键SS按下，如果此时恢复按钮SFF被触发，机器人电动病床根据STM32F407伺服控制器的速度和加速度要求，把位移SLS和SHS转化为电机Z和电机R的加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，MC2340再结合电机Z和电机R对应的磁电传感器M3、M4的速度和位移反馈生成驱动直流无刷伺服电机Z和电机R的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机Z和电机R运动，床体被恢复到自然状态。

8）当STM32F407 控制器检测到启动键SS按下，STM32F407 控制器将检测侧向转弯按钮SK是否被触发。如果侧向转弯按钮SK被触发， STM32F407根据机器人运动部分需要旋转角度和其内部梯形发生器，把直流无刷伺服电机X和Y要运转的距离SX转化为加速度、速度和位置参考指令值，STM32F407将于MC2340通讯，然后MC2340再结合电机X和电机Y的磁电传感器M1、M2的反馈生成驱动直流无刷伺服电机X和电机Y的驱动信号，驱动信号经功率桥放大后驱动直流无刷伺服电机X和电机Y以相反的方向运动，在运动过程M1和M2实时反馈电机的运行参数给STM32F407，STM32F407转化处理后与MC2340通讯，MC2340根据反馈参数二次微调电机X和电机Y的PWM控制信号，使得旋转系统在规定时间内完成侧转任务，由于在此过程中只是电机X和电机Y组成的旋转部分旋转90度，并未改变电动病床的方向，提高了机器人电动病床在狭小空间的实用性。

9）当STM32F407 控制器检测到启动键SS按下，如果此时只有前进按钮SF被触发，机器人电动病床将开始向前运动，在运动过程中，机器人携带的前方防撞超声波传感器S9和S10将工作，并向STM32F407 控制器时刻反馈其与前方障碍物的距离。如果防撞超声波传感器S9或者是S10读取到前方有障碍物时，STM32F407将于MC2340通讯，MC2340经内部伺服控制程序调整直流无刷伺服电机X和电机Y的PWM输出，控制机器人电动病床在安全范围内停车，控制器并开启一个三秒的计时，如果三秒后控制器依旧读取到障碍物则通知人机界面改换行走轨迹；如果三秒后障碍物信号消息，则机器人电动病床将按照当前路径继续启动前进。在机器人电动病床运动过程中，磁电传感器M1、M2会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移，并反馈给STM32F407，由STM32F407处理转化后将于MC2340通讯，MC2340二次调整直流无刷电机X和电机Y的PWM波控制信号以满足实际需求 。

10）当STM32F407 控制器检测到启动键SS按下，如果此时只有后退按钮SB也被触发，机器人电动病床将开始后退运动，STM32F407将于MC2340通讯，MC2340 经内部伺服控制程序调整直流无刷伺服电机X和电机Y的PWM输出，控制机器人电动病床按照设定速度缓慢后退；在后退运动过程中，磁电传感器M1、M2会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移，并反馈给STM32F407 ，STM32F407 根据磁电传感器M1和M2的速度和位移反馈二次处理后将于MC2340通讯，MC2340二次调整直流无刷伺服电机X和电机Y的PWM输出，保证机器人电动病床在安全速度范围内运行，防止速度过快机器人电动病床推倒护工人员。

11）当STM32F407 控制器检测到启动键SS按下，如果此时转弯按钮SK和前进按钮SF被触发，机器人电动病床将开始侧向右移，在运动过程中，机器人携带的侧方防撞超声波传感器S6将工作，并向STM32F407 控制器时刻反馈其与前方障碍物的距离。如果防撞超声波传感器S6读取到右方有障碍物时，STM32F407将于MC2340通讯，MC2340 经内部伺服控制程序调整直流无刷伺服电机X和电机Y的PWM输出，控制机器人电动病床在安全范围内停车，控制器并开启一个三秒的计时，如果三秒后控制器依旧读取到障碍物存在将向人机界面发出停车报警；如果三秒后障碍物信号消息，则机器人电动病床将按照当前轨迹继续侧向右移。在机器人电动病床侧向右移过程中，磁电传感器M1、M2会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移，并反馈给STM32F407 ，由STM32F407二次处理转化后将于MC2340通讯，MC2340 二次调整电机X和电机Y的运动参数，保证系统满足行走要求。

12）当STM32F407 控制器检测到启动键SS一旦按下，如果此时转弯按钮SK和前进按钮SB被触发，机器人电动病床将开始侧向左移，在运动过程中，机器人携带的侧方防撞超声波传感器S7将工作，并向STM32F407 控制器时刻反馈其与前方障碍物的距离。如果防撞超声波传感器S7读取到运动前方有障碍物时，STM32F407将于MC2340通讯，MC2340 经内部伺服控制程序调整直流无刷伺服电机X和电机Y的PWM输出，控制机器人电动病床在安全范围内停车，控制器并开启一个三秒的计时，如果三秒后控制器依旧读取到障碍物存在将向人机界面发出停车报警；如果三秒后障碍物信号消息，则机器人电动病床将按照当前轨迹继续侧向左移。在机器人电动病床侧向左移过程中，磁电传感器M1、M2会时刻检测直流无刷伺服电机X和电机Y的运动速度和位移，并反馈给STM32F407 ，由STM32F407二次转化处理后将于MC2340通讯，MC2340 二次调整电机X和电机Y的运动参数，保证系统满足实际需求。

13）当机器人电动病床需要移出病房时，先有医院负责人开启行走权限密码，可以有护工人员推出房间，也可以有护工人员把机器人电动病床推到带有地面导航标志的位置，机器人电动病床进入自动导航状态：其导航的光电传感器S1、S2、S3、S4、S5将工作，地面标志反射回来的光电信号反馈给STM32F407 ，经STM32F407 判断处理后确定机器人偏移导航轨道的偏差，STM32F407 把此偏差信号转化为电机X和电机Y要运行的加速度、速度和位移指令，STM32F407将于MC2340通讯，MC2340再结合磁电编码器M1和M2的反馈生产驱动直流无刷伺服电机X和电机Y的驱动信号，驱动信号放大后驱动直流无刷电机X和电机Y向前运动，快速调整机器人电动病床迅速回到导航轨道中心。机器人电动病床沿着轨道行走过程，MC2340根据地面标志和磁电编码器M1和M2的反馈微调电机X和电机Y的驱动信号，使机器人沿着设定好的轨道顺利通过病房门口。当铺设的轨道消失后，机器人电动病床就停在原地等待人为移动信号，防止误操作。

14）本机器人电动病床在运动过程为了防止护士的误操作以及遇到紧急状况停车，加入了紧急停车自动锁车功能。如遇到紧急情况，当紧急按键ESW1按下后，控制器一旦检测到紧急中断请求会发出原地停车指令，MC2340通过驱动器封锁直流无刷伺服电机X和电机Y的PWM波信号，即使电动病床多个万向轮都处于可以滑动状态，由于行走电机X和电机Y处于锁死状态，这样机器人电动病床也不会运动，保证了机器人在紧急状况下的安全性。

15）本发明在机器人电动病床上加入了湿度检测系统。此湿度检测系统由湿敏传感器、测量电路和显示记录装置等几部分组成，分别完成信息获取、转换、显示和处理等功能，这样当病人大小便失控时，湿度检测系统会工作，将发出报警信号，护工人员通过人机界面输出可以查出故障原因，然后更换床褥。

16）本电动床装备了多种防障碍物报警系统，机器人障碍物探测系统可以在机器人病床碰撞到障碍物之前自动探测到障碍物的存在并通过控制器协助自动停车，并根据障碍物的性质确定二次启动或是一直待在原地不动，这样就保证了机器人病床在运动过程中对周围环境的适应，减少了环境对其的干扰。

17）在机器人电动病床行走过程中，直流无刷伺服电机经常会受到外界因素干扰，为了减少电机的脉动转矩对机器人行走的影响，控制器在考虑电机特性的基础上加入了对电机转矩的在线辨识，并利用电机力矩与电流的关系进行及时补偿，削弱了外界环境对机器人运动的影响。

18）在机器人电动病床行走期间伺服控制器全程开启加速度计A1，加速度计A1可以测量机器人病床三个前进方向的加速度，控制器根据测得的加速度通过连续积分就可以得到其速度和位移，为机器人的三闭环控制提供可靠判据；同时当机器人病床的姿态发生变化时，控制器就可以得到其大致倾斜角度和加速度要求，控制器根据倾斜角度和加速度需求就可以大致计算出功率需求，然后调整各台直流无刷伺服电机的功率以满足爬坡和加速需要；控制器通过对加速度计A1进行连续积分，且把它变换到医院导航坐标系中，机器人电动病床可以不依赖于任何外部信息就能够得到其在医院导航坐标系中的加速度、速度、偏航角和位置等信息，控制器实时进行存储和显示。

本发明具有的有益效果是：

1：在控制过程中，充分考虑了电池在这个系统中的作用，基于ARM（STM32F407）+MC2340控制器时刻都在对机器人电动病床的运行状态和电源来源进行监测和运算，当交流电源切断时，病床会借助自携带蓄电池电源自锁在固定位置，直至有移动病床的开关信号输入，保证了病床的自然状态。

2：为了方便使用，减少外界对病床的干扰，护工人员、护士人员以及医院管理人员均需要开启权限才可以启动机器人电动病床，减少了误操作的危险。

3：为了方便病人自理，减少对外界条件的依赖，本系统加入了人机界面功能，病人只要通过电脑触摸屏就可以自动控制病床机器人，这样就可以不需要护理而自己解决部分简易的日常生活。

4：由于此电动病床加入了基于蓄电池的动力助力装置，即使碰到病人身体肥胖或者护理人员身体瘦弱时，病床本身在电源充足的条件下可以为护工人员和护士人员在屋子里移动病床提供动力，减少了护士或者护工人员在屋子里移动病床的体力消耗和劳动强度。

5：由于此电动病床加入了基于直流无刷伺服电机的两轮差速驱动系统，使得病床可以在屋子里实现自由移动，减少了病人在某一个固定位置的压抑感。

6：由于此电动病床加入了基于直流无刷伺服电机的两轮差速驱动系统，使得单台电机的功率大大降低，并且动力与地面的接触点有两点，有利于提高电动病床行驶时的操控性。

7：由于加入了基于直流无刷伺服电机的两轮差速驱动系统，在非常狭小的空间内可以使病床机器人侧向移动，减少机器人旋转带来的负面问题。

8：为了能够使机器人病床能够自由移出病房门口，控制器加入了多种导航传感器，机器人在移出病房过程中一旦读到地面标志就会自动导航，减少人工移动病床带来的误差。

9：当机器人电动病床遇到爬坡的时，由于自身携带的有动力能源，所以可以很好的起到助力作用，并且双轮驱动的动力特性远远优越于单轮驱动，进一步减少了对护工人员体力的要求。

10：由MC2340处理两轴电机差速行驶、两轴自由升降电机的全数字伺服控制，大大提高了运算速度，解决了单单片机运行较慢的瓶颈，缩短了开发周期短，并且程序可移植能力强。

11：本发明完全实现了单板控制，不仅节省了控制板占用空间，而且还完全实现了多轴电机控制信号的同步，有利于提高医用机器人电动病床的稳定性和动态性能。

12：由于本控制器采用MC2340处理大量的多轴伺服数据与算法，并充分考虑了周围的干扰源，把STM32F407从复杂的计算中解脱出来，有效地防止了程序的“跑飞”，抗干扰能力大大增强。

13：本机器人电动病床加入了自动锁车功能，当病床机器人在移动过程中，如遇到紧急情况，控制器会发出原地停车指令，并锁死两轮差速行驶电机，即使多个万向轮都处于可以滑动状态，但由于驱动轮处于锁死状态，这样机器人也不会运动。

14：本机器人电动病床加入了湿度检测系统。此湿度检测系统由湿敏传感器、测量电路和显示记录装置等几部分组成，分别完成信息获取、转换、显示和处理等功能，这样当病人大小便失控或者是床单潮湿时，湿度检测系统会工作，发出更换请求。

15：本电动床机器人装备了多种报警系统，在碰撞到障碍物之前自动停车，这样就保证了在运动过程中的安全性，减少了环境对其的干扰。

16：由于本机器人电动病床系统采用直流无刷伺服电机替代了直流电机，不仅进一步提高了系统的安全性，也可以提高能源的利用率，增加了机器人电动病床在携带能源一定的条件下一次移动的距离。

17：由于本机器人电动病床系统采用直流无刷伺服电机，当电机受到外界干扰产生脉动转矩时，直流无刷伺服电机可以利用力矩与电流的关系迅速进行补偿，极大减少了外界干扰对机器人电动病床的影响。

18：基于单轴直流无刷伺服电机的头部伺服控制部分可以很好的满足病人需要抬起头部或者是仰起上半身的活动，护理人员可以通过按键达到升起病床前部，病床的自动化程度进一步得到提升，减少了护理人员的劳动量。

19：基于单轴直流无刷伺服电机的腿部伺服控制部分可以很好的满足病人需要腿部或者下半身的活动，护理人员可以通过按键达到升起或降低病床后部，病床的自动化程度进一步得到提升，减少了护理人员的劳动量。

20：基于前后两轴直流无刷伺服升降装置组合使得机器人电动病床具有各种机械组合，在推离病人离开病房时，可以根据病人的病情自由调节病床的姿势，满足了不同病人的心理要求。

21：加速度计A1用来测量机器人病床三个前进方向的加速度，控制器根据测得的加速度通过连续积分就可以得到其速度和位移，可以为机器人的三闭环控制提供可靠判据；

22：加速度计A1可以提高机器人电动病床在行走过程中导航的稳定性，实现姿态的自动精确调整、计算加速爬坡时需要的功率。

以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书内容所作的等效结构或等效流程变换，或直接或间接运用在其它相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (7)

1.一种双核双轮驱动自由升降机器人电动病床控制器，其特征在于，包括交流电源、电池、控制板、电机X、电机Y、电机Z以及电机R，所述的交流电源和电池提供电流驱动所述的控制板，所述的控制板采用双核控制器，包括ARM和MC2340，所述的ARM和MC2340进行通信连接，由所述的MC2340发出第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号，所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号经驱动放大后分别驱动所述的电机X、电机Y、电机Z和电机R，所述的电机X、电机Y、电机Z、和电机R上设置有磁电编码器，通过磁电编码器由所述的电机X、电机Y、电机Z和电机R控制所述的机器人电动病床的前进、运行速度、运行方向和升降运动。

2.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的电池采用锂离子电池。

3.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的电机X、电机Y、电机Z和电机R均采用直流无刷伺服电机。

4.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的ARM采用STM32F407。

5.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的第一驱动信号、第二驱动信号、第三驱动信号和第四驱动信号均为PWM波驱动信号。

6.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的双核双轮驱动自由升降机器人电动病床控制器还包括加速度计和陀螺仪，所述的加速度计和陀螺仪设置在机器人电动病床上。

7.根据权利要求1所述的双核双轮驱动自由升降机器人电动病床控制器，其特征在于，所述的双核双轮驱动自由升降机器人电动病床控制器还设置有人机界面程序和运动控制系统，所述的人机界面程序包括人机界面、区域规划以及在线输出，所述的运动控制系统包括基于MC2340四轴直流无刷电机伺服控制、数据存储以及I/O控制，所述的基于MC2340四轴直流无刷电机伺服控制包括基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制，其中，基于MC2340两轴直流无刷电机双轮驱动伺服控制和基于MC2340两轴直流无刷电机自由升降伺服控制均包括磁电编码器模块、基于磁电编码器加速度模块、基于磁电编码器速度模块以及基于磁电编码器位移模块。