上肢康复机器人的安全控制方法和装置的制造方法_2

文档序号:9254019阅读:来源:国知局
要是防止上肢康复机器人伸缩臂无限伸缩而导致病人受到损伤,对运动力度的检测主要是防止力度太大对病人造成损伤。例如,如果用力过猛(直接表现就是病人运动速度过快)或者是伸张范围过大(直接表现就是病人手臂扩展的范围过大),病人的上肢一时承受不住,难免使得病人受到损伤,加重病情。在检测到伸缩臂的这些运动数据超出预定的安全阈值的情况下,及时关闭电机,从而可以有效避免损伤的产生。
[0050]下面对上述几种情况进行具体描述:
[0051]I)在上肢康复机器人伸缩臂的运动数据为上肢康复机器人伸缩臂的运动次数的情况下,运动数据限值就是上肢康复机器人伸缩臂的运动次数限值。
[0052]在检测到伸缩臂的运动次数大于运动次数限值的情况下,会控制上肢康复机器人电机停止运转,然而,这种情况主要是因为计数器计数溢出导致的,在这个时候,还需要生成对计数器进行复位操作的复位指令,其中,所述计数器用于统计所述上肢康复机器人伸缩臂的运动次数;然后,将所述复位指令发送给计数器以对计数器进行复位操作,这样在重新启动后,计数器可以进行正常的运行状态。
[0053]2)在上肢康复机器人伸缩臂的运动数据为上肢康复机器人伸缩臂的运动距离的情况下,运动数据限值为上肢康复机器人伸缩臂的运动距离限值。
[0054]考虑到伸缩臂是向三个方向运动的,因此上肢康复机器人伸缩臂的运动范围包括:伸缩臂在X方向上的运动范围、伸缩臂在Y方向上的运动范围、伸缩臂在Z方向上的运动范围,即,需要保证伸缩臂在每个方向的运动范围(或者说运动距离)都是安全的。
[0055]在一个实施例中,上述方法还包括:所述方法还包括:获取所述上肢康复机器人中的光电传感器采集到的数据,其中,所述光电传感器用于采集所述伸缩臂的运动距离;确定所述光电传感器采集到的运动距离数据是否超出所述光电传感器的安装位置;如果是,则生成用于控制所述电机停止运转的控制指令。即,通过光电传感器进行限位,具体的,就是由光电传感器检测伸缩臂的运动距离,如果发现伸缩臂的运动距离已经超出了光电传感器的安装位置,那么也会产生中断信号,以使得电机停止工作。例如:在上肢康复机器人上安装光电传感器,当光电传感器检测到在伸缩臂在X、Y、Z方向上的运动范围超出了光电传感器的安装位置时,光电传感器会发出指令,控制电机停止工作,这种方式可以称为电气限位。
[0056]对于上述的电气限位可以是在用于进行运动距离限值判断失效或者故障的情况下的一种保护措施,为了实现对伸缩臂在三个方向上的全方位保护,在三个方向的两端都需要设置光电传感器,也就是一共设置六个光电传感器。
[0057]进一步的,为了更好地进行安全保护,还可以进行机械限位,机械限位作为最后重保护,是在中断装置和光电传感器都失效的情况下,通过机械力的作用来终止所述伸缩臂的继续运动,即在控制所述上肢康复机器人的伸缩臂的运动范围的中断装置和所述光电传感器都出现故障的情况下,在所述伸缩臂运动到机械限位装置时,通过所述机械限位装置所产生的机械外力,终止机械臂的继续运动。这种方式也可以称为机械限位,和上述的电气限位一样,机械限位也需要在三个方向的两端都设置机械限位装置,也就是一共设置六个机械限位装置。
[0058]3)在上肢康复机器人伸缩臂的运动数据为上肢康复机器人伸缩臂的运动力度的情况下,所述运动数据限值是上肢康复机器人伸缩臂的运动力度限值。
[0059]在具体实施的过程中,考虑到每种工作状态的检测和触发机理是不同的,因此,为了更为有效地进行控制,可以为不同的工作状态设置不同的用于控制上肢康复机器人中的电机停止运行的中断装置,这个中断装置也可以称之为看门狗,可以认为是一种内嵌在系统中的软件程序或者协议,用于触发进行安全保护。
[0060]为了使得电机可以随时被停止,而无需等到状况发生以后再终止电机的运行,以便对一些意外情况进行处理,可以在设置急停开关,从而实现快速的电机急停处理。
[0061]在一个实施例中,不同类型的运动数据对应不同的控制装置,例如:用于对伸缩臂的运动力度进行控制的控制装置,与用于对伸缩臂的运动范围进行控制的控制装置就是不同的,不同的控制装置之间采用串联的方式进行连接。即,对于上述的几种工作情况的中断装置相互之间是级联的,也就是串联的,只要有一个中断装置控制电机关闭,那么整个系统都会停止,即,任何一个都可以打开或切断电机电源。
[0062]下面结合一个具体的实施例,来对本发明上述实施例进行具体描述,然而值得注意的是,该具体实施例仅是为了更好地描述本发明,并不构成对本发明的不当限定。
[0063]在本例中,提供了一种对上肢康复机器人进行安全保护的安全系统,该系统通过多个看门狗,对任务控制处理器、联合控制器、和安全处理器进行控制和保护,其中,任务控制处理器主要是对系统运行次数的管理,联合控制器主要是对伸缩臂的作用力的管理、安全处理器主要是对伸缩臂的伸缩范围的管理。进一步的,每个处理器本身都具备直接生成驱动模块(Actuators and Drives)可执行命令的功能。
[0064]下面对用于上述三个处理器控制器的看门狗进行具体描述:
[0065]任务控制处理器(Task Controller Processor)的看门狗是内嵌于固件(Firmware )中,在系统开始运行的时候也就相应的启动了看门狗的计数器,看门狗开始自动计数,当计数器的计数达到一定的时间还未清空看门狗,那么看门狗计数器就会溢出,从而引起看门狗中断,电机停止运行,系统复位,从而可以有效防止MCU死机.,在任务控制处理器中,看门狗的主要作用就是防止程序跑飞。
[0066]联合控制器(Joint Controller Processor)的看门狗是固件和软件之间的一项通讯协议,当传感器(Endpoint Force Sensor)所感知的力大于预先设定的安全阈值时,该值经过联合控制器(Joint Controller Processor)计算后输入安全系统(Safe System),并转化为驱动模块(Actuator and Drives)的可执行命令,从而实现对电机(Motor)的刹车保护。
[0067]安全处理器(Safety Processor)的看门狗是软件内部的限位控制程序,通过该程序规定了伸缩臂运动端在X、Y、Z方向上的最大运动范围,当安全处理器(SafetyProcessor)的看门狗判断出运动端位置不在规定范围时,即生成电机的可执行命令,控制电机停止工作。
[0068]进一步的,可以安装紧急按钮,具体的,可以在医观屏的上方,或者是机械臂在中间位置时对应的主机正下方设置急停开关,只需要按下医观屏上方的急停开关或者拔下前方的急停开关,都可以使得电机45失电。
[0069]行程限位主要包括:电气限位(Electrical Limiter)和机械限位(MechanicalLimiter),正如上述所述的电气限位和机械限位都需要在X、Y、Z的两端分别设置相应的限位装置。
[0070]具体的,电器限位是在X、Y、Z三轴的运动方向的两端都设置光电传感器(Photoelectric Sensor)。当上述安全控制器的看门狗失效时,如果X、Y、Z三个方向的运动超过光电传感器的安装位置,传感器会发出指令,控制电机停止运行。机械限位是在X、Y、Z三轴的运动方向的两端都设置机械硬限位装置,从位置的设置而言,机械限位装置都是设置在光电传感器的外延位置,当电气限位的失效时,三个方向运动到机械限位装置时,均会因机械外力的作用停止。
[0071]基于同一发明构思,本发明实施例中还提供了一种上肢康复机器人的安全控制装置,如下面的实施例所述。由于上肢康复机器人的安全控制装置解决问题的原理与上肢康复机器人的安全控制方法相似,因此上肢康复机器人的安全控制装置的实施可以参见上肢康复机器人的安全控制方法的实施,重复之处不再赘述。以下所使用的,术语“单元”或者“模块”可以实现预定功能的软件和/或硬件的组合。尽管以下实施例所描述的装置较佳地以软件来实现,但是硬件,或者软件和硬件的组合的实现也是可能并被构想的。图3是本发明实施例的上肢康复机器人的安全控制装置的一种结构框图,如图3所示,包括:第一确定模块301、第一获取模块302、第一生成模块303和第一发送模块304,下面对该结构进行说明。
[0072]第一确定模块301,用于确定允许上肢康复机器人电机运转的所述上肢康复机器人伸缩臂的运动数据
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1