本发明涉及一种在考虑与机器人的周围机械接触的条件下用于控制和调节机器人的致动器的方法和设备,其中,该机器人包括至少两个部件,这些部件通过可由致动器驱动的铰链连接相连,从而可以使这些部件彼此相对运动。
背景技术:
机械的周围接触的理解和解释对于机器人的致动运动的部件(例如机械臂的肢体(gliedern))的控制和调节而言有着重要的意义,特别是在机器人和人的相互作用和相互合作过程中。在此涉及的是,在期望的接触事件和不期望的接触事件之间进行区分,即区分出碰撞。期望的接触事件通常可由机器人的任务而得出,例如在预设的相互作用区域中的对物件进行操纵和/或进行机器人和人的相互作用。不期望的接触事件是指所有不期望发生的接触事件。特别是与在机器人周围的物品或人的碰撞(这些物品或人未处于预设的相互作用区域内),或者是与周围本身的碰撞。
技术实现要素:
本发明的目的在于说明一种在考虑周围接触的情况下用于控制和调节机器人的致动器的改进的方法和改进的设备。
本发明可由独立权利要求的特征得出。有利的扩展方案和设计方案为从属权利要求的主题。本发明其它的特征、应用可能性和优点可由以下的描述以及附图中示出的本发明实施例的说明中得出。
在方法方面,上述目的通过一种在考虑周围接触的情况下用于控制和调节机器人的致动器的方法得以实现,其中,机器人包括至少两个部件,这些部件通过能够由致动器驱动的铰链连接相连。这些部件可以是机械臂的肢体、头、躯干或仿真机器人的四肢。该机器人特别是可以包括多个部件,这些部件通过多个能够由致动器驱动的铰链连接相连。
该方法包括以下步骤。在第一步骤中借助传感器系统确定和存储一维或多维的与时间有关的量g(t),通过该量能够描述一个或多个外部的接触力fext和/或一个或多个外部的力矩mext对这些部件随着时间的作用。量g(t)特别可以是多维的,即具有多个分量:g(t)=[g1(t),g2(t),g3(t),g4(t),...]。该量g(t)例如可以说明一个或多个力和/或一个或多个扭矩和/或一个或多个机械张力和/或一个或多个压力,或者说明一个或多个由此确定的一维或多维的量。该量g(t)的分量可能与第j个铰链连接或第j个部件有关,即,分别为多个部件和/或为多个铰链连接确定量g(t)的分量。
传感器系统有利地包括用于检测力、力矩、张力和/或压力的测量传感器,另外还包括分析电子装置和至少用于临时储存测量结果的存储单元。该传感器系统有利地包括接近传感器
有利的是,该传感器系统包括基于测量传感器当前的测量数据估计或预测力、力矩、张力和/或压力的单元。有利的是,在估计/预测过程中使用与物件碰撞的历史测量数据。
在第二步骤中,为量g(t)提供条件b。条件b可以是随着时间变化的和/或与机器人的状态有关的。简单的条件b例如是:g(t)的数值:|g(t)|小于或等于极限值f,|g(t)|≤f。可能的一维表达式例如为:|gi(t)|≤fi,其中,g(t)=[gi(t)];f=[fj],而且i=1,2,...,i。条件b有利地这样选择,以使得能够区分外力fext和/或力矩mext在机器人的可移动部件上的作用和不作用,其中由目前出发,只要满足条件b,则不存在外力fext和/或力矩mext的作用。
可以有利地这样选择条件,以使得该条件允许在没有外力或外力矩作用下的机器人的运行和具有外力或外力矩作用下的机器人的运行之间进行区分。
条件b可以有利地例如由此确定,即,机器人在没有外力fext(除了重力和在一定情况下的科里奥利力
在第三步骤中,只要在时间t0由g(t)不满足条件b,则为已测得的量g(t)经过时间间隔t=[ta,te]确定一个特征向量
-在时间间隔t内g(t)的中位数或平均值,
-在时间间隔t内g(t)的最小值和最大值,
-在时间间隔t内g(t)与中位数或平均值的偏差,
-在时间间隔t内g(t)的信号宽度,
-在时间间隔t内g(t)的频谱,以及
-该频谱的一个或多个特征频率。
以上逻辑说明了时间点t0,在该时间点上由g(t)不再能满足预设的条件b,即,由该时间点起,外力fext或力矩作用在至少一个部件或铰链连接上。有利地,时间间隔t的起始ta和时间间隔t的终止te是与时间有关的:ta=ta(t)且te=te(t),或者仅时间间隔t的终止te是与时间有关的:te=te(t)。在第一种情况下,间隔t例如可以以时间t在时间方向上延长。在第二种情况下,时间间隔t单侧变得更大,即,时间点ta是固定的而仅te(t)以时间t延长。时间间隔t有利地具有10ms、20ms、50ms、75ms、100ms、250ms、500ms、750ms、1s、1.5s、2.0s、2.5s、3.0s、4.0s、5.0s、6.0s、7.0s或者10s的长度。
在第四步骤中借助预设的类别对已确定的特征向量
特征向量
在第五步骤中,根据分类结果ke在时间t>t0内进行致动器的控制和/或调节。根据已确定的分类结果ke有利地进行致动器的控制和/或调节,以使得部件的运动停止、减缓、加速,或者是开始沿相反方向的运动。加速的运动以及沿相反方向的运动对应于为了减少对机器人或碰撞物件的潜在损坏的偏转运动。
发明人已发现,所提出的方法,并且特别是所提出的特征向量
当特征向量
-在时间间隔t内信息内容的量度,例如g(t)的香农熵(shannon-entropie)或香农熵分布,和/或
-在时间间隔t内一个或多个g(t)的hjorth参数,比如g(t)的活动性、移动性或复杂性,和/或
-在时间间隔t内一个或多个g(t)的能量相关参数,和/或
-在时间间隔t内一个或多个g(t)的自相关参数,和/或
-在时间间隔t内一个或多个g(t)的倾斜参数(schiefe-parameter),和/或
-在时间间隔t内一个或多个g(t)的光谱相位参数(spektralephasen-parameter),和/或
-在时间间隔t内一个或多个g(t)的光谱幅度参数(spektraleamplituden-parameter)。
另外有利的是,特征向量
本发明的目的另外还通过一种具有数据处理设备的计算机系统得以实现,其中,该数据处理设备设计为,在该数据处理设备上实施如上所述的方法。
另外,本发明的目的还通过一种具有电子可读控制信号的数字存储介质得以实现,其中,该控制信号可以与可编程的电脑系统共同作用,以实施如上所述的方法。
另外,本发明的目的还通过一种具有存储在机器可读的载体上的程序代码的计算机程序产品得以实现,当在数据处理设备上实施该程序代码时,该计算机程序产品用于执行如上所述的方法。
最后,本发明还涉及一种具有程序代码的计算机程序,当该程序在数据处理设备上运行时,该计算机程序用于执行如上所述的方法。为此,该数据处理设备可以设计为任意的现有技术已知的计算机系统。
在本发明的设备方面,通过一种在考虑周围接触的条件下用于控制和调节机器人的致动器的设备得以实现,其中,该机器人包括至少两个部件,这些部件通过能够由致动器驱动的铰链连接相连,该设备具有:用于确定和存储与时间有关的量g(t)的传感器系统,通过该量能够描述一个或多个外部的接触力fext和/或一个或多个外部的力矩mext对这些部件随着时间的作用;用于为该量g(t)提供条件b的接口(schnittstelle);分析单元,其实施和设置为,只要在时间t0上由g(t)不能满足条件b,则为已确定的量g(t)经过时间间隔t=[ta,te]确定特征向量
传感器系统的传感器可以有利的是由接近传感器和力传感器组成的组合,其中,力传感器不必一定要能够区分牵拉和挤压(由其作用于身体的哪一侧的信息所导致,力是否牵拉或挤压),在这种情况下,接近传感器例如可以解决这种模糊性。
所提出的设备的扩展和优点可通过对所提出的方法的实施从意义上或类似的改写而得出。
附图说明
其它的优点、特征以及细节可由以下描述中得出,其中(在必要时参照附图)详细地描述了至少一个实施例。相同的、类似的和/或功能相同的部分设有相同的附图标记。其中,
图1为按照本发明的方法的流程图,而且
图2为按照本发明的设备的示意性构造。
具体实施方式
图1示出了按照本发明的方法的流程图,该方法在考虑周围接触的条件下用于控制和调节机械臂的三个致动器,其中,在本实施例中的机械臂包括四个臂区段,这些臂区段通过三个分别能够由多个致动器中的一个来驱动的铰接链接而连续地连接。在该实施例中,三个铰链连接中每一个另外还具有用于检测力矩测量值mi(t)的力矩传感器,其中i=1,2,3。在时间进程中,由各个力矩传感器检测力矩测量值mi(t)的时间序列。
除了力矩传感器之外,传感器系统还包括分析单元和存储单元。该传感器系统在第一步骤101中基于力矩测量值mi(t)确定当前作用到机械臂上的、与时间有关的总力矩g(t)。
通常力矩测量值mi(t)不能直接得到外部的总力矩g(t),因为还必须要考虑到惯性力、科里奥利力和重力。为此,通常必须估计或至少代数地(对于存在加速度传感器的情况)确定外部的总力矩g(t)。
因此,在该实施例中,量g(t)是一个标量(skalare
在第二步骤102中,为量g(t)提供条件b,在该情况下,条件为g(t)≤f。条件b或极限值f这样选择,即,只要不进行与机械臂的周围接触,即,既不存在期望的也不存在不期望的接触事件,则满足条件b。为此可以在试验序列中确定相应的极限值f,在这些试验序列中机械臂实施随即运动,而不发生周围接触。在此,致动器的调节为校正步骤,该校正步骤尝试改善外部的扭矩和/或扭力的测量或评估。
只要在时间t0上通过g(t)不满足条件b,即,出现了周围接触,则在第三步骤103中为量g(t)经过时间间隔t=[ta,te]确定特征向量
-在时间间隔t内g(t)的中位数,
-在时间间隔t内g(t)的最小值和最大值,
-在时间间隔t内g(t)与中位数的偏差,
-在时间间隔t内g(t)的信号宽度,
-在时间间隔t内g(t)的频谱,以及
-该频谱的固有频率。
在第四步骤104中,借助可能的特征向量
在第五步骤105中,根据该分类结果ke在时间t>t0内进行致动器的控制和/或调节。在此例如在一个查询表中针对每个分类结果ke对控制和/或调节进行预设。但也可以通过数学公式,例如微分方程进行关联。
图2示出了一种在考虑周围接触的条件下用于控制和调节机器人的致动器的设备,其中,机器人包括至少两个部件,这些部件通过能够由致动器驱动的铰链连接相连。该设备包括:一个用于确定和存储与时间有关的量g(t)的传感器系统201,通过该量能够描述一个或多个外部的接触力fext和/或一个或多个外部的力矩mext对这些部件的随着时间的作用;一个用于为该量g(t)提供条件b的接口202;一个分析单元203,其实施和设置为,只要在时间t0上通过g(t)不满足条件b,则在为量g(t)经过时间间隔t=[ta,te]确定特征向量
附图标记列表
101-105方法步骤
201传感器系统
202接口
203分析单元
204分类单元
205用于控制和/或调节致动器的单元