CN103038030B - 弹性体致动器驱动机构的控制装置及控制方法 - Google Patents
弹性体致动器驱动机构的控制装置及控制方法 Download PDFInfo
- Publication number
- CN103038030B CN103038030B CN201180036581.9A CN201180036581A CN103038030B CN 103038030 B CN103038030 B CN 103038030B CN 201180036581 A CN201180036581 A CN 201180036581A CN 103038030 B CN103038030 B CN 103038030B
- Authority
- CN
- China
- Prior art keywords
- unit
- output
- action
- elastomer actuator
- target
- 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.)
- Expired - Fee Related
Links
- 230000007246 mechanism Effects 0.000 title claims abstract description 126
- 238000000034 method Methods 0.000 title claims description 14
- 230000002159 abnormal effect Effects 0.000 claims abstract description 159
- 238000005259 measurement Methods 0.000 claims abstract description 12
- 230000009471 action Effects 0.000 claims description 237
- 229920001971 elastomer Polymers 0.000 claims description 228
- 239000000806 elastomer Substances 0.000 claims description 228
- 239000012530 fluid Substances 0.000 claims description 20
- 230000005856 abnormality Effects 0.000 abstract description 5
- 230000001276 controlling effect Effects 0.000 description 62
- 230000001133 acceleration Effects 0.000 description 29
- 230000015572 biosynthetic process Effects 0.000 description 15
- 230000008485 antagonism Effects 0.000 description 14
- 238000001514 detection method Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 5
- 230000008602 contraction Effects 0.000 description 5
- 238000003860 storage Methods 0.000 description 5
- 230000004323 axial length Effects 0.000 description 3
- 230000001419 dependent effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 239000000835 fiber Substances 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 3
- 238000012549 training Methods 0.000 description 3
- 238000000205 computational method Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 239000013536 elastomeric material Substances 0.000 description 2
- 210000000245 forearm Anatomy 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000011664 signaling Effects 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 238000009530 blood pressure measurement Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 230000010339 dilation Effects 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 230000003864 performance function Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Classifications
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/14—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid
- B25J9/142—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid comprising inflatable bodies
-
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B11/00—Servomotor systems without provision for follow-up action; Circuits therefor
- F15B11/16—Servomotor systems without provision for follow-up action; Circuits therefor with two or more servomotors
-
- 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
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0218—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults
- G05B23/0243—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults model based detection method, e.g. first-principles knowledge model
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/705—Output members, e.g. hydraulic motors or cylinders or control therefor characterised by the type of output members or actuators
- F15B2211/7051—Linear output members
- F15B2211/7052—Single-acting output members
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/71—Multiple output members, e.g. multiple hydraulic motors or cylinders
- F15B2211/7107—Multiple output members, e.g. multiple hydraulic motors or cylinders the output members being mechanically linked
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39454—Rubber actuator, two muscle drive, one for extension other for traction
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39462—Pneumatic actuator, imitates human muscle
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Fluid Mechanics (AREA)
- General Engineering & Computer Science (AREA)
- Manipulator (AREA)
Abstract
一种弹性体致动器驱动机构的控制装置及控制方法、以及控制程序,具有判断输出测量机构(8)是否异常的异常判断机构(49),通过判断输出测量机构的异常,而在输出测量机构异常时,不使用输出测量机构的测量结果,利用内部状态模型,按照能够实现输出的目标值的方式生成目标内部状态信息,对弹性体致动器(1)进行动作控制。
Description
技术领域
本发明涉及对通过流体压力驱动致动器等利用弹性体的变形被驱动的弹性体致动器驱动的驱动机构的动作进行控制的、弹性体致动器驱动机构的控制装置及控制方法、以及控制程序。
近年来,由于元件生产工厂的扩张等,与人协作的机器人的开发非常盛行。这样的与人协作的机器人,与以往那样划分人所处的区域和机器人用的作业区域而动作的机器人不同,需要与人共同生活,因此与以往的工业用机器人等在必要的规格方面不同。
第一,在以往的工业用机器人中,使用电动马达或减速器,通过高增益的反馈控制,实现所谓反复精度0.1mm等的高手指位置精度。但是,通过被这样的电动马达驱动的机构,大多数情况下刚性高、缺乏柔软性,在所谓安全性方面存在很多问题。
与此相对,在与人协作的机器人中,重视在与人接触时不会危害人等安全性。因此,不能说像以往的工业用机器人那样由电动马达驱动的机构能够适于家庭用机器人等重视安全性的领域,而需要柔软且安全的机器人手臂。
对于这样的问题,例如提出了利用McKibben型的气压致动器的机器人手臂。McKibben型的气压致动器,在由橡胶材料构成的管状弹性体的外表面配设由纤维线材构成的约束单元,成为由密封构件对管状弹性体的两端部进行气密密封的构造。通过流体注入注出单元而由空气等压缩性流体对管状弹性体的内部空间施加内压时,管状弹性体主要在半径方向上膨胀,利用约束单元的作用,将要在半径方向上膨胀的运动变换成管状弹性体的中心轴方向上的运动,总长收缩。该McKibben型的致动器主要由弹性体构成,所以其特征在于,是具有柔软性且安全、轻量的致动器。
第二,以往的工业用机器人,在与人隔离的空间进行动作,所以在例如发生传感器的故障等时,立即停止动作认为是最安全的。
与此相对,在与人在相同空间活动的机器人的情况下,在假设发生了传感器故障等情况下,立即停止动作未必是最安全的。例如,在与人进行协同动作时,在机器人突然停止的情况下,在进行协同动作的人无法迅速停止,所以认为成为危险状态等情形。但是,在传感器发生故障时,有无法获得动作控制所必需的信息,难以继续动作的问题。
对于这样的传感器的故障,以往技术公开了通过读入预先示教并存储的数据来代替传感器信号以对机器人进行控制的控制装置(专利文献1)。另外,公开了在具有距离传感器和多个移动机构位置检测器的机器人中具有运算器的移动控制装置,所述运算器从来自距离传感器的传感器信号和来自正常的移动机构位置检测器的移动机构位置信号,求出与发生了故障的移动机构位置检测器原本应该输出的正确的移动机构位置信号相同的替代信号(专利文献2)。
【现有技术文献】
专利文献1:日本实公平8-1819号公报
专利文献2:日本特公平5-55279号公报
但是,在专利文献1的技术中,代替传感器信号的示教数据是预先必须的,但存在难以事先想好机器人的所有动作、难以准备示教数据的问题。另外,在专利文献2的技术中,存在不具有距离传感器的机器人等无法运算正确的替代信号的问题。
发明内容
本发明的目的在于,解决上述以往的问题,无需预先准备示教数据或具有能运算替代信号的传感器,即便在传感器异常时也不立即停止动作,能使由弹性体致动器驱动的机器人手臂等驱动机构的动作继续的、弹性体致动器驱动机构的控制装置及控制方法、以及控制程序。
为了实现上述目的,本发明如下所示构成。
根据本发明的一实施方式,提供一种弹性体致动器驱动机构的控制装置,其具有:
异常判断单元,其判断对弹性体致动器的输出进行测量的输出测量单元是否异常,
正常时动作控制单元,其在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上述输出测量单元的输出,进行上述弹性体致动器驱动机构的控制动作,
异常时动作控制单元,其在由上述异常判断单元判断为上述输出测量单元异常时,利用上述内部状态模型,进行上述弹性体致动器驱动机构的控制动作,和
控制单元,其在上述异常判断单元判断上述输出测量单元为正常时使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作;
上述正常时动作控制单元具有:
输出上述弹性体致动器的输出的目标值的第一目标输出单元、和
利用上述目标输出单元的输出和来自上述输出测量单元的输出算出目标关节转矩的转矩控制单元,
上述正常时动作控制单元,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作;
进而,上述异常时动作控制单元具有:
输出上述弹性体致动器的输出的目标值的第二目标输出单元、和
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型获得上述弹性体致动器的目标内部状态信息的目标内部状态信息获得单元,
上述异常时动作控制单元,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的另一实施方式,提供一种弹性体致动器驱动机构的控制方法,其中,
由异常判断单元来判断对弹性体致动器的输出进行测量的输出测量 单元是否异常,
在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上述输出测量单元的输出,由正常时动作控制单元进行上述弹性体致动器驱动机构的控制动作,另一方面,
在由上述异常判断单元判断为上述输出测量单元异常时,利用内部状态模型,由异常时动作控制单元进行上述弹性体致动器驱动机构的控制动作,并且,
在上述异常判断单元判断上述输出测量单元为正常时,通过控制单元使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时,通过上述控制单元从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作,
在上述正常时动作控制单元进行动作时,
由第一目标输出单元输出上述弹性体致动器的输出的目标值,
利用上述目标输出单元的输出和来自上述输出测量单元的输出,由转矩控制单元算出目标关节转矩,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作,另一方面,
进而,在上述异常时动作控制单元进行动作时,
由第二目标输出单元输出上述弹性体致动器的输出的目标值,
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型,由目标内部状态信息获得单元获得上述弹性体致动器的目标内部状态信息,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的其他实施方式,提供一种弹性体致动器驱动机构的控制程序,其用于使计算机实现如下的功能:
由异常判断单元来判断对弹性体致动器的输出进行测量的输出测量单元是否异常的功能,
在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上 述输出测量单元的输出,由正常时动作控制单元进行上述弹性体致动器驱动机构的控制动作的功能,
在由上述异常判断单元判断为上述输出测量单元异常时,利用内部状态模型,由异常时动作控制单元进行上述弹性体致动器驱动机构的控制动作的功能,和
在上述异常判断单元判断上述输出测量单元为正常时,通过控制单元使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时,通过上述控制单元从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作的功能;
在上述正常时动作控制单元进行动作时,
由第一目标输出单元输出上述弹性体致动器的输出的目标值的功能,和
利用上述目标输出单元的输出和来自上述输出测量单元的输出,由转矩控制单元算出目标关节转矩,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作的功能;另一方面,
进而,在上述异常时动作控制单元进行动作时,
由第二目标输出单元输出上述弹性体致动器的输出的目标值的功能,
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型,由目标内部状态信息获得单元获得上述弹性体致动器的目标内部状态信息,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制的功能。
【发明效果】
根据本发明的弹性体致动器驱动机构的控制装置,具有控制单元、正常时动作控制单元和异常时动作控制单元,进而,在正常时动作控制单元内具有判断输出测量单元是否发生故障的异常判断单元而构成。通过这样的构成,在由异常判断单元判断输出测量单元不正常时,控制单元能够进行从正常时动作控制单元向异常时动作控制单元的动作的切换。其结果, 异常时动作控制单元不使用上述弹性体致动器的输出的测量结果,利用内部状态模型,进行弹性体致动器驱动机构的控制动作,由此按照弹性体致动器继续动作的方式进行控制。由此,即便在输出测量单元发生了故障的情况下,弹性体致动器驱动机构不立即停止动作,可以继续动作的安全的弹性体致动器驱动机构的控制成为可能。
另外,根据本发明的弹性体致动器驱动机构的控制方法以及控制程序,具有判断输出测量单元是否发生故障的异常判断动作。通过这样的构成,在由异常判断单元判断为输出测量单元不正常时,控制单元可以进行从正常时动作控制单元向异常时动作控制单元的动作切换。其结果,异常时动作控制单元不使用上述弹性体致动器的输出的测量结果,利用内部状态模型,进行弹性体致动器驱动机构的控制动作,由此按照弹性体致动器继续动作的方式进行控制。因此,即便在输出测量单元发生了故障的情况下,弹性体致动器驱动机构也不立即停止动作,可以继续动作的安全的弹性体致动器驱动机构的控制成为可能。
附图说明
本发明的这些和其他目的和特征,根据有关附图的优选实施方式涉及的下述记述而加以明确。这些附图如下所示。
图1是表示本发明的第一实施方式中的弹性体致动器的驱动机构的构造的图。
图2是表示第一实施方式中的作为弹性体致动器的一例的弹性膨胀收缩构造体的构造以及动作的图。
图3是表示用于通过作为压缩性流体的空气对本发明的第一实施方式中的机器人手臂进行驱动的气压供给系统的动作的图。
图4是表示本发明的第一实施方式中的弹性体致动器驱动机构的控制装置的整体构成的框图。
图5是表示本发明的第一实施方式中的主控制部的构成的框图。
图6A是表示本发明的第一实施方式中的内部状态模型的方程式的例子的图。
图6B是表示本发明的第一实施方式中的内部状态模型的方程式的例 子的图。
图7是本发明的第一实施方式中的主控制部的控制程序的动作步骤的流程图。
图8是本发明的第一实施方式中的正常时动作控制部的控制框图。
图9是本发明的第一实施方式中的转矩控制单元的计算方法的一部分的图。
图10是表示本发明的第一实施方式中的弹性体致动器的特性的一例的图。
图11是表示本发明的第一实施方式中的异常判断单元的内部框图的图。
图12是本发明的第一实施方式中的正常时动作控制部的控制程序的动作步骤的流程图。
图13是本发明的第一实施方式中的异常时动作控制部的控制框图。
图14是表示本发明的第一实施方式中目标内部状态决定单元的详细构成的框图。
图15是本发明的第一实施方式中异常时动作控制部的控制程序的动作步骤的流程图。
图16是本发明的第二实施方式中异常时动作控制部的控制框图。
具体实施方式
以下,根据附图对本发明涉及的实施方式进行详细说明。
以下,在参照附图对本发明中的实施方式进行详细说明之前,对本发明的各种方式进行说明。
根据本发明的第一实施方式,提供一种弹性体致动器驱动机构的控制装置,其具有:
异常判断单元,其判断对弹性体致动器的输出进行测量的输出测量单元是否异常,
正常时动作控制单元,其在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上述输出测量单元的输出,进行上述弹性体致动器驱动机构的控制动作,
异常时动作控制单元,其在由上述异常判断单元判断为上述输出测量单元异常时,利用内部状态模型,进行上述弹性体致动器驱动机构的控制动作,和
控制单元,其在上述异常判断单元判断上述输出测量单元为正常时使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作;
上述正常时动作控制单元具有:
输出上述弹性体致动器的输出的目标值的第一目标输出单元、和
利用上述目标输出单元的输出和来自上述输出测量单元的输出算出目标关节转矩的转矩控制单元,
上述正常时动作控制单元,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作;
进而,上述异常时动作控制单元具有:
输出上述弹性体致动器的输出的目标值的第二目标输出单元、和
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型获得上述弹性体致动器的目标内部状态信息的目标内部状态信息获得单元,
上述异常时动作控制单元,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的第二实施方式,在第一实施方式记载的控制装置的基础上,其中,上述异常时动作控制单元的上述目标内部状态信息获得单元具有:利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型,算出目标内部状态的信息的第一目标内部状态算出单元,根据由上述目标内部状态算出单元算出的上述目标内部状态的信息进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的第三实施方式,在第一实施方式记载的控制装置的基础 上,其中,上述异常时动作控制单元的上述目标内部状态信息获得单元具有:
从上述内部状态模型和上述弹性体致动器的内部状态的信息推定上述弹性体致动器的输出的输出推定部、和
从由上述输出推定部推定的上述弹性体致动器的输出和由上述第二目标输出单元输出的上述输出的目标值算出目标内部状态信息的第二目标内部状态信息算出单元,
根据利用由上述输出推定部推定的上述弹性体致动器的输出算出的上述目标内部状态的信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的第四实施方式,在第一实施方式记载的控制装置的基础上,其中,上述异常判断单元,将来自上述输出测量单元的输出和来自对上述弹性体致动器的内部状态进行测量的内部状态测量单元的内部状态的关系的信息、与上述输出测量单元为正常时的内部状态模型的上述弹性体致动器的输出和上述弹性体致动器的内部状态的关系的信息加以比较,判断上述输出测量单元是否异常。
根据本发明的第五实施方式,在第一~四中任意一种实施方式记载的弹性体致动器驱动机构的控制装置的基础上,其中,进而,上述异常时动作控制单元内的上述第二目标输出单元和上述正常时动作控制单元内的上述第一目标输出单元,输出上述弹性体致动器的不同输出的目标值,在上述异常时动作控制单元进行动作时,按照上述弹性体致动器动作到安全的位置之后动作停止的方式由上述异常时动作控制单元进行控制。
根据本发明的第六实施方式,在第一~五中任意一种实施方式记载的弹性体致动器驱动机构的控制装置的基础上,其中,上述弹性体致动器是流体压力致动器。
根据本发明的第七实施方式,提供一种弹性体致动器驱动机构的控制方法,其中,
由异常判断单元来判断对弹性体致动器的输出进行测量的输出测量单元是否异常,
在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上 述输出测量单元的输出,由正常时动作控制单元进行上述弹性体致动器驱动机构的控制动作,另一方面,
在由上述异常判断单元判断为上述输出测量单元异常时,利用内部状态模型,由异常时动作控制单元进行上述弹性体致动器驱动机构的控制动作,并且,
在上述异常判断单元判断上述输出测量单元为正常时,通过控制单元使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时,通过上述控制单元从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作,
在上述正常时动作控制单元进行动作时,
由第一目标输出单元输出上述弹性体致动器的输出的目标值,
利用上述目标输出单元的输出和来自上述输出测量单元的输出,由转矩控制单元算出目标关节转矩,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作,另一方面,
进而,在上述异常时动作控制单元进行动作时,
由第二目标输出单元输出上述弹性体致动器的输出的目标值,
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型,由目标内部状态信息获得单元获得上述弹性体致动器的目标内部状态信息,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制。
根据本发明的第八实施方式,提供一种弹性体致动器驱动机构的控制程序,其用于使计算机实现如下的功能:
由异常判断单元来判断对弹性体致动器的输出进行测量的输出测量单元是否异常的功能,
在由上述异常判断单元判断为上述输出测量单元正常时,利用来自上述输出测量单元的输出,由正常时动作控制单元进行上述弹性体致动器驱动机构的控制动作的功能,
在由上述异常判断单元判断为上述输出测量单元异常时,利用内部状态模型,由异常时动作控制单元进行上述弹性体致动器驱动机构的控制动作的功能,和
在上述异常判断单元判断上述输出测量单元为正常时,通过控制单元使上述正常时动作控制单元进行动作,另一方面,在上述异常判断单元判断上述输出测量单元为异常时,通过上述控制单元从上述正常时动作控制单元向上述异常时动作控制单元切换而使上述异常时动作控制单元进行动作的功能;
在上述正常时动作控制单元进行动作时,
由第一目标输出单元输出上述弹性体致动器的输出的目标值的功能,和
利用上述目标输出单元的输出和来自上述输出测量单元的输出,由转矩控制单元算出目标关节转矩,根据由上述转矩控制单元算出的上述目标关节转矩,进行上述弹性体致动器驱动机构的控制动作的功能;另一方面,
进而,在上述异常时动作控制单元进行动作时,
由第二目标输出单元输出上述弹性体致动器的输出的目标值的功能,
利用由上述第二目标输出单元输出的上述输出的目标值和上述内部状态模型,由目标内部状态信息获得单元获得上述弹性体致动器的目标内部状态信息,不使用上述弹性体致动器的输出的测量结果,根据由上述目标内部状态信息获得单元获得的上述目标内部状态信息,进行上述弹性体致动器驱动机构的控制动作,由此按照上述弹性体致动器继续动作的方式进行控制的功能。
以下,参照附图对本发明的实施方式进行说明。
(第一实施方式)
对第一实施方式的弹性体致动器驱动机构10的控制装置30的具体构成的一例进行说明。
图1是表示本发明的第一实施方式涉及的弹性体致动器驱动机构10的构成的图。弹性体致动器驱动机构10是2自由度的机器人手臂,具有在含有正交的x轴和y轴的xy平面内正反旋转的第一关节轴6-1、和同样 在xy平面内正反旋转的第二关节轴6-2。在图1中,1-1a、1-1b、1-2a、1-2b(它们是与单个的弹性膨胀收缩构造体(弹性体致动器或流体压力致动器的一例)对应的参照符号,在代表性地指示弹性膨胀收缩构造体时用参照符号1表示。)是弹性膨胀收缩构造体。第一关节轴6-1和第二关节轴6-2,分别是指弹性体致动器驱动机构(在本实施方式中为弹性膨胀收缩构造体驱动机构)10的第一关节和第二关节的旋转轴。
如图2所示,关于弹性膨胀收缩构造体1,是在由橡胶材料构成且作为驱动部发挥功能的管状的中空弹性体2的外表面,配设由在材料上难以伸展的树脂或金属的纤维线材编织成网状的变形方向限制构件3。关于变形方向限制构件3,构成为管状弹性体2的膨胀导致的半径方向的变形被变换成与半径方向正交的轴方向的长度的收缩,另一方面,管状弹性体2的收缩导致的半径方向的变形被变换成轴方向的长度的膨胀。管状弹性体2的两端部由密封构件4分别加以气密密封。弹性膨胀收缩构造体1的一个端部的密封构件4所具备的管状的流体通过构件5,内部具有压缩性流体通过的流体的流路,可以通过流体通过构件5,相对于中空弹性体2的中空内部进行流体的注入或者注出。通过流体通过构件5,空气等压缩性流体被提供给中空的管状弹性体2。需要说明的是,流体通过构件5可以分别位于弹性膨胀收缩构造体1的密封构件4的两个端部。
利用被供给的压缩性流体向管状弹性体2的内部空间施加内压时,管状弹性体2主要在半径方向上膨胀。但是,通过变形方向限制构件3的作用,被变换成管状弹性体2的中心轴方向的运动,总长收缩,因此可以用作直动驱动的弹性体致动器。
返回到图1,弹性体致动器驱动机构10按照使关节轴6-1或6-2与支点对置的方式配设1组弹性膨胀收缩构造体1。1组弹性膨胀收缩构造体1中的任意一方弹性膨胀收缩构造体1进行收缩,另一方的弹性膨胀收缩构造体1进行伸展。此外,借助支点(关节轴6-1或6-2)而力发挥作用,成为关节轴6-1或6-2的轴旋转的拮抗型驱动构造,可以实现在关节轴6-1或6-2的正反旋转运动。具体而言,通过弹性膨胀收缩构造体1-1a和弹性膨胀收缩构造体1-1b的拮抗驱动,第一关节轴6-1进行正反旋转驱动。通过弹性膨胀收缩构造体1-2a和弹性膨胀收缩构造体1-2b的拮抗驱动,第 二关节轴6-2进行正反旋转驱动。
下端固定于固定面14的棒状的支承构件16的上端,以自由旋转的方式支承有能与第一关节轴6-1同心旋转的作为一例的圆板型的支承体19。在支承构件16的下端部的固定面14侧,固定有与支承构件16的长度方向正交延伸的棒状支承体18。在支承体19和支承体18之间,弹性膨胀收缩构造体1-1a以及1-1b各自的端部以自由旋转的方式连结。由此,通过弹性膨胀收缩构造体1-1a以及1-1b的拮抗驱动,支承体19绕第一关节轴6-1的支承轴21在xy面内正反旋转。其结果,能够使与支承体19(在图3中示作矩形板状构件。)连结的弹性体致动器驱动机构10的前臂支承构件17进行正反旋转。
前臂117的支承构件17,基端固定于支承体19(图3中示出),可以与支承体19一体旋转。
另外,支承构件17的顶端侧,连结成按照与支承构件17的长度方向正交地延伸的方式固定的棒状的支承体20的中心可以绕第二关节轴6-2的轴芯旋转。在连接有支承构件17的一端的支承体19和顶端侧的支承体20之间,弹性膨胀收缩构造体1-2a以及1-2b各自的端部以自由旋转的方式连结。由此,通过弹性膨胀收缩构造体1-2a以及1-2b的拮抗驱动,支承体20绕第二关节轴6-2的支承轴22在xy面内进行正反旋转。其结果,可以使与支承体20连结的握持物体用的手部12相对地正反旋转。
在手部12安装有手部开闭用的马达13,通过使该马达13进行动作来闭合手部12,从而可以握持搬运物体11。以下将该手部12的位置以及姿势作为手指位置以及姿势进行说明。
压力传感器9-1a、9-1b是对弹性膨胀收缩构造体1-1a、1-1b各自的内部状态(作为一例是内部压力)进行测量的内部状态测量单元的一例。压力传感器9-1a、9-1b配设于弹性膨胀收缩构造体1-1a、1-1b各自的流体通过构件5(流体注入注出口),对各弹性膨胀收缩构造体1-1a、1-1b内的压力进行测量。同样地,在弹性膨胀收缩构造体1-2a、1-2b上也配设有作为内部状态测量单元的一例的压力传感器9-2a、9-2b。
在弹性膨胀收缩构造体1-1a以及1-1b、弹性膨胀收缩构造体1-2a以及1-2b上,如后述那样分别连接有三端口(port)流量比例电磁阀27(27A、 27B)。所有的流量比例电磁阀27与由一般的个人电脑以及输入输出IF29构成的控制计算机28连接。控制计算机28,借助流量比例电磁阀27,分别独立地对弹性膨胀收缩构造体1-1a以及1-1b、弹性膨胀收缩构造体1-2a以及1-2b各自的收缩以及伸展动作进行控制。另外,在各关节轴6-1、6-2配设作为输出测量单元的一例的位移测量单元(在本第一实施方式中是作为一例的编码器8),可以通过各编码器8对各关节轴6-1、6-2的关节角度进行测定。在各弹性膨胀收缩构造体1配设作为内部状态测量单元的一例的压力测量单元(在本第一实施方式中是作为一例的压力传感器9(9-1a、9-1b、9-2a、9-2b)),可以通过压力传感器9对各弹性膨胀收缩构造体1的内部压力进行测定。
只要为如上之类的构造,可以产生多自由度且实现物体的握持以及搬运等作为弹性体致动器驱动机构10的基本功能。
图3是表示用于驱动本发明的第一实施方式涉及的弹性体致动器驱动机构10的气压供给系统的构成的图。
在图3中,仅记载对弹性体致动器驱动机构10的第二关节轴6-2进行正反旋转驱动的部分,省略其他的部分。对弹性体致动器驱动机构10的第一关节轴6-1进行正反旋转驱动的部分也是相同构造,发挥相同作用。
在图3中,25是例如压缩机等气压源,26是对气压源25的气压进行调节而输出的气压调节组件。作为流量比例电磁阀的一例的4个三端口流量控制电磁阀27,通过以电磁铁的力驱动滑阀等来进行流量控制。控制计算机28,搭载D/A板等输入输出IF29,向4个三端口流量控制电磁阀27分别输出电压指令值,由此可以独立地控制流过各个流体通过构件5的各空气的流量。
接着,对图3所示的气压供给系统的动作进行说明。由气压源25生成的高压空气被气压调节组件26减压,例如,调节成所谓600[kPa]的恒定压力,提供给三端口流量控制电磁阀27。三端口流量控制电磁阀27的开度,通过控制计算机28控制成与经由输入输出IF29输出的电压指令值成比例。在从控制计算机28向与弹性膨胀收缩构造体1-2a连接的三端口流量控制电磁阀27A输入正的电压指令值的情况下,从气压源25侧向弹性膨胀收缩构造体1-2a侧的流路开通,流量与电压指令值的绝对值成比例 的空气被提供给弹性膨胀收缩构造体1-2a侧。同时,如果向与弹性膨胀收缩构造体1-2b连接的三端口流量控制电磁阀27B输入负的电压指令值,就弹性膨胀收缩构造体1-2b侧而言,向大气压侧的流路开通,流量与电压指令值的绝对值成比例的空气流从弹性膨胀收缩构造体1-2b侧被排向大气中。
因此,如图2所示,弹性膨胀收缩构造体1-2a(与图2的下侧的弹性膨胀收缩构造体对应。)的总长收缩,弹性膨胀收缩构造体1-2b(与图2的上侧的弹性膨胀收缩构造体对应。)总长伸展,第二关节轴6-2以与电压指令值的绝对值成比例的速度进行右旋转运动。另一方面,在从控制计算机28向与弹性膨胀收缩构造体1-2a连接的三端口流量控制电磁阀27A输入负的电压指令值,向与弹性膨胀收缩构造体1-2b连接的三端口流量控制电磁阀27B输入正的电压指令值的情况下,弹性膨胀收缩构造体1-2a、1-2b的动作相反(即,弹性膨胀收缩构造体1-2a总长伸展,弹性膨胀收缩构造体1-2b的总长收缩),而第二关节轴6-2进行左旋转运动。
即,从三端口流量控制电磁阀27向弹性膨胀收缩构造体1侧供给的空气流,利用流体通过构件5通过密封构件4,到达管状弹性体2的内部,产生管状弹性体2的内压。管状弹性体2因产生的内压而膨胀,但通过变形方向限制构件3的编织成网络状的纤维线材的约束作用(限制作用),膨胀所致的半径方向的变形受到限制,变换成轴方向的长度的收缩,如图3的上侧(图2的下侧)所示,弹性膨胀收缩构造体1总长缩短。另一方面,如果将空气从三端口流量控制电磁阀27排到大气中,减小管状弹性体2的内压,因管状弹性体2的弹力而复原,膨胀被消除,弹性膨胀收缩构造体1的总长如图3的下侧(图2的上侧)所示进行伸展。
其结果,在图2中,认为在右端被固定时,因为上述伸缩而在管状弹性体2的左端有距离d的差。因此,第一实施方式中的弹性膨胀收缩构造体1,可以通过对气压进行供给控制而作为直动位移的致动器发挥功能。伸展以及缩短量与弹性膨胀收缩构造体1的内压大致成比例,所以如果用控制计算机28对三端口流量控制电磁阀27进行控制,以对向弹性膨胀收缩构造体1供给的空气流量进行控制,可以对弹性膨胀收缩构造体1的总长进行控制。
如上所示,在图1所示的弹性体致动器驱动机构10中,为了弹性膨胀收缩构造体1-1a和1-1b进行拮抗驱动、以及弹性膨胀收缩构造体1-2a和1-2b进行拮抗驱动,对拮抗的一对弹性膨胀收缩构造体1的每个都配设三端口流量控制电磁阀27,构成与图3相同的气压供给系统。此外,通过利用控制计算机28经由输入输出IF29向各个三端口流量控制电磁阀27输出的电压指令值,使弹性体致动器驱动机构10的全部的关节轴6-1、6-2能同时独立地进行正反旋转驱动。
图4是表示本发明的第一实施方式涉及的弹性体致动器驱动机构10的控制装置30的整体构成的图,上述控制装置30例如配置在上述控制计算机28内。控制装置30具有主控制部(控制部或控制单元的一例)31、正常时动作控制部(正常时动作控制单元)32和异常时动作控制部(异常时动作控制单元)33。正常时动作控制部32和异常时动作控制部33接受来自主控制部31的控制部动作指令信号而进行动作,排他性地进行动作(即,在一方的动作控制部进行动作时,另一方的动作控制部不进行动作)。主控制部31从正常时动作控制部32输入异常检测信号和握持物体信息。从异常时动作控制部33向主控制部31输入握持物体信息。另外,主控制部31分别向正常时动作控制部32和异常时动作控制部33输出内部状态模型和控制部动作指令信号。
图5是表示主控制部31的具体构成的图。主控制部31具有内部状态模型数据库34、数据库选择输出部35、控制部切换指令输出部36、运转时间信息记录部37。
在内部状态模型数据库34中,储存有与作为拮抗的1对弹性膨胀收缩构造体1的压力之差ΔP和对应的关节的角度q的关系的数据(内部状态模型)。所谓内部状态模型,是指在编码器8正常的情况下,弹性体致动器驱动机构10根据动作程序进行动作时的、以各自的时间计的每个点的弹性体致动器1的压力差ΔP以及作为关节角度q的关系的信息的基准信息。
图6A以及图6B是表示在内部状态模型数据库34中存储的能够求出压力差ΔP和对应的关节的角度q的关系的数据的方程式的例子的图。在图6A以及图6B的例子中,曲线图所示的2次方程式存储在内部状态模 型数据库34内。弹性膨胀收缩构造体1的压力差ΔP和对应的关节的角度q的关系因握持的物体的重量而变化或因时效变化(随时间变化)等而变化,所以将多个方程式存储在内部状态模型数据库34内。在本实施方式的例子中,依照握持物体的种类和经过时间而作成数据。图6A是未用弹性体致动器驱动机构10握持物体时的方程式的例子,是弹性体致动器驱动机构10的100小时动作前和100小时动作后的关系的例子。图6B是用弹性体致动器驱动机构10握持物体时的方程式的例子,是弹性体致动器驱动机构10的100小时动作前和100小时动作后的关系的例子。进而,将这样的方程式按各关节存储在内部状态模型数据库34内。
返回图5,运转时间信息记录部37对弹性体致动器驱动机构10的之前的运转时间进行记录,向数据库选择输出部35输出其结果。这里所说的“之前的运转时间”是指将开始驱动弹性体致动器驱动机构10之后的运转时间加以累积的时间。
关于数据库选择输出部35,被输入后述的握持物体信息即是否在握持物体的信息、和作为运转时间信息记录部37的输出的运转时间,根据选择所必需的信息选择内部状态模型数据库34内的合适的数据,将所选择的结果作为内部状态模型向正常时动作控制部32或异常时动作控制部33中正在运转的一方输出。
例如,在被输入握持物体信息而在握持物体的状况且被输入的运转时间是50小时的情况下,输出由图6A中的“◆”(黑菱形)的点表示的方程式。另外,如果运转时间为150小时,则输出由图6A的图中的“■”(黑四边形)的点表示的方程式。
关于控制部切换指令输出部36,被输入正常时动作控制部32的异常检测信号,将输出控制部动作指令的对象从正常时动作控制部32切换成异常时动作控制部33。关于异常检测信号,在后述的正常时动作控制部32检测到输出检测部的异常时从正常时动作控制部32向主控制部31输出。就控制部切换指令输出部36的实际的动作步骤而言,根据图7的流程图进行说明。
在步骤S21中,控制部切换指令输出部36向正常时动作控制部32输出控制部动作指令。即,在弹性体致动器驱动机构10的起动后,开始由 正常时动作控制部32进行作为控制装置30(换言之,控制计算机28)的控制动作。
接着,在步骤S22中,由主控制部31进行异常检测信号是否从正常时动作控制部32向主控制部31输出的确认。
以下,对在步骤S22中由主控制部31已判断异常检测信号未从正常时动作控制部32向主控制部31输出时进行说明。
此时,从步骤S22返回到步骤S21,从主控制部31向正常时动作控制部32输出控制部动作指令。
通过反复进行以上的步骤S21~S22,正常时动作控制部32未检测到输出测量单元的异常时,控制部切换指令输出部36向正常时动作控制部32继续输出控制部动作指令,正常时动作控制部32继续进行动作。
以下,对在步骤S22中由主控制部31判断异常检测信号从正常时动作控制部32向主控制部31输出时进行说明。
此时,从步骤S22进入步骤S23。在步骤S23中,从主控制部31向异常时动作控制部33输出控制部动作指令。
进而,一旦发生了步骤S23,反复进行步骤S23直至弹性体致动器驱动机构10的动作结束。
在反复进行以上的步骤而由主控制部31判断为正常时动作控制部32检测到输出测量单元的异常时,控制部切换指令输出部36向异常时动作控制部33继续输出控制部动作指令,异常时动作控制部33继续进行动作。
图8是表示本发明的第一实施方式涉及的正常时动作控制部32的具体构成的图。正常时动作控制部32具有目标轨道生成单元(第一目标输出单元的一例)40、输出误差计算部41、角度误差补偿单元42、目标角加速度计算单元43、矫正目标角加速度计算部44、正常时转矩控制单元45A、压力误差计算部46、压力误差补偿单元47、握持物体信号输出单元48、和异常判断单元49。不过,在图8中,驱动装置50是图1中的流量比例电磁阀27(27A、27B)以及输入输出IF29,10是作为弹性体致动器驱动机构的控制装置21的控制对象的图1所示的弹性体致动器驱动机构10。从弹性体致动器驱动机构10输出各关节轴6-1、6-2的由各编码器8测量的作为测量值的一例的关节角的当前值(关节角度矢量)q=[q1,q2]T、 和各弹性膨胀收缩构造体1的由压力传感器9测量的作为内部状态测量值的一例的弹性膨胀收缩构造体1的内压P=[P1a、P1b、P2a、P2b]T。不过,q1、q2分别是由编码器8测量的第一关节轴6-1、第二关节轴6-2的关节角度。另外,P1a、P1b、P2a、P2b分别是由压力传感器9(9-1a、9-1b、9-2a、9-2b)测量的弹性膨胀收缩构造体1-1a、1-1b、1-2a、1-2b的内压。手部用马达13是进行手部12开闭的马达,接受握持物体信号的输入(握持物体信号的输出ON),闭合手部12而进行物体的握持,另一方面,接受不输出握持物体信号(握持物体信号的输出OFF),打开手部12而进行物体的握持解除。
关于目标轨道生成单元40,向输出误差计算部41、目标角加速度计算单元43、握持物体信号输出单元48输出用于实现成为目标的弹性体致动器驱动机构10的动作的目标关节角度矢量(输出的目标值的一例)qd。在目标轨道生成单元40内,预先存储弹性体致动器驱动机构10的动作程序。成为目标的弹性体致动器驱动机构10的动作,根据目的作业事先存储有以各自的时间(t=0、t=t1、t=t2、…)计的每个点的目标角度矢量qdt=[qdt1,qdt2]T(qdt=0、qdt=1、qdt=2、…)。此外,目标轨道生成单元40,根据以各自的时间(t=0、t=t1、t=t2、…)计的每个点的角度(qdt=0、qdt=1、qdt=2、…)的信息,使用多项式插值,对各点间的轨道进行插值,生成目标关节角度矢量qd=[qd1,qd2]T。
输出误差计算部41,被输入从目标轨道生成单元40输出的目标关节角度矢量qd和编码器8的输出q,计算角度误差矢量qe=qd-q,作为输出误差的一例而输出角度误差矢量qe。
角度误差补偿单元42,被输入由输出误差计算部41输出的角度误差矢量qe,作为控制指令值的一例而向矫正目标角加速度计算部44输出角度误差矫正指令值ΔPqe。
目标角加速度计算单元43,被输入由目标轨道生成单元40输出的目标关节角度矢量qd,目标角加速度(下述[数1])通过计算而被求出,向矫正目标角加速度计算部44输出。
[数1]
矫正目标角加速度计算部44,被输入作为目标角加速度计算单元43的输出的(下述[数2])和作为角度误差补偿单元42的输出的角度误差矢量ΔPqe,作为控制指令值的一例,矫正目标角加速度(下述[数3])通过计算而被求出,向正常时转矩控制单元45A输出。
[数2]
[数3]
正常时转矩控制单元45A,从作为标角加速度计算部44的输出的矫正目标角加速度(下述[数4])
[数4]
和动态参数,计算目标关节转矩τd,进而从目标关节转矩τd和被输入的编码器8的输出q,算出相应的(关注的)关节的弹性膨胀收缩构造体1的目标压力值(目标内部状态信息的一例)Pd。作为动态参数的例子,是指弹性体致动器驱动机构10的各联杆(支承构件16、17)或传送物体11的质量、重心位置、或惯性矩阵等。正常时转矩控制单元45A向压力误差计算部46输出已算出的目标压力值Pd。作为目标关节转矩τd的计算方法的一例,使用弹性体致动器驱动机构10的运动方程式,用以下的式子算 出目标关节转矩τd。
[数5]
[数6]M(q)及是由传送物体11以及弹性体致动器驱动机构10的动态参数构成的系数矩阵,
[数7]g(q)是传送物体11以及弹性体致动器驱动机构10的质量涉及的重力项。
使用图9以及图10,对通过所求出的目标关节转矩τd和关节角度q计算各关节的弹性膨胀收缩构造体1的目标压力值Pd的方法的一例进行说明。
图9是表示针对某关节角度的弹性膨胀收缩构造体1-a、1-b的长度的图。图10是表示作为图9中使用的弹性膨胀收缩构造体1-a、1-b的特性的拉伸力F和应变量ε以及压力P的关系的图。图9所示的弹性膨胀收缩构造体1-a、1-b的各关节的几何学参数、以及图10所示的弹性膨胀收缩构造体1-a、1-b的特性,被预先存储在正常时转矩控制单元45A中。
如图9所示,首先,通过正常时转矩控制单元45A根据关节角度q计算相应的(关注的)关节(在该例子中为第二关节)的拮抗的一对弹性膨胀收缩构造体1-2a、1-2b各自的长度。如图9所示,以2根弹性膨胀收缩构造体1-2a、1-2b间的距离为2n且关节角度为q(支承体20相对于弹性膨胀收缩构造体1-2a、1-2b的轴方向倾斜角度q)的情况为例时,弹性膨胀收缩构造体1-2a、1-2b的长度的差成为下述[数8],
[数8]
2n·sinq
q=0时的弹性膨胀收缩构造体1-2a、1-2b的长度均为l0时,各弹性膨胀收缩构造体1-2a、1-2b的长度可以根据以下的式子由正常时转矩控制单元 45A求出。
[数9]
la=l0-n·sinq
lb=l0+n·sinq
进而,弹性膨胀收缩构造体1-2a、1-2b的自然长度为l时,各自的应变量为εa=la/l、εb=lb/l,可以由正常时转矩控制单元45A求出。
另外,将各关节的弹性膨胀收缩构造体1-2a、1-2b的拉伸力F的差设为Fe时,通过正常时转矩控制单元45A由目标关节转矩τd按下述[数10]求出。
[数10]
可以根据以上的条件、即各弹性膨胀收缩构造体1-2a、1-2b的应变量ε以及拉伸力F的差Fe,进而根据事先决定的1个条件、(例如,拮抗的2个弹性膨胀收缩构造体1-2a、1-2b的平均压力为300kPa,弹性膨胀收缩构造体1-2a、1-2b的压力差为200kPa等),使用图10,由正常时转矩控制单元45A求出各弹性膨胀收缩构造体1-2a、1-2b的目标压力值Pd。
例如,在图9的例子中,εa=5[%]、εb=0[%]、Fe=2000[N]、事先决定的条件设为平均压力250[kPa]。
首先,根据εa以及εb,确定各弹性膨胀收缩构造体1-2a、1-2b的状态分别位于图10的箭头a以及箭头b所示的纵线上。
接着,根据拉伸力F的差Fe,确定各弹性膨胀收缩构造体1-2a、1-2b的状态是位于图10的纵轴上有2000N的距离。
在由正常时转矩控制单元45A在图10上探寻满足以上的条件且平均压力为250[kPa]的各弹性膨胀收缩构造体1-2a、1-2b的压力时,可以由正常时转矩控制单元45A求出弹性膨胀收缩构造体1-2a的压力为400[kPa]、 弹性膨胀收缩构造体1-2b的压力为100[kPa]。这些求出的压力是目标压力值Pd。
与传送物体11对应的动态参数,预先存储在正常时转矩控制单元45A内。根据来自手部12的手部状态信号而手部12闭合以握持物体11时,正常时转矩控制单元45A使用握持物体时的动态参数,另一方面,手部12打开而不再握持物体11时,正常时转矩控制单元45A使用未握持物体时的动态参数,所以变成下述[数11]。
[数11]
M(q)和和g(q)
关于压力误差计算部46,从由正常时转矩控制部45A输出的弹性膨胀收缩构造体1-2a、1-2b的目标压力值Pd减去由压力传感器9输出的压力P,算出压力误差Pe,向压力误差补偿单元47输出已算出的压力误差Pe。
关于压力误差补偿单元47,从压力误差计算部46被输入压力误差Pe,算出压力差误差矫正输出VΔpe,向弹性体致动器驱动机构10的驱动装置50输出已算出的压力差误差矫正输出VΔpe。压力差误差矫正输出VΔpe,经由驱动装置50的D/A板等的输入输出IF29,作为电压指令值被提供给气压供给系统的三端口流量控制电磁阀27(27A、27B),各关节轴6-1、6-2被分别独立地正反旋转驱动,弹性体致动器驱动机构10进行动作。
关于握持物体信号输出单元48,向手部用马达13和主控制部31输出事先决定的目标位置的握持物体信号。在本实施方式中,事先决定作为机器人的一例的弹性体致动器驱动机构10的任务。此外,设想用手部12在某位置握持传送物体11,移动传送物体11,在其他位置放置传送物体11(从手部12的握持放开传送物体11)的例子。为此,由目标位置决定握持物体信号的输出的ON/OFF,但不限于此,可以是操作者按压手部开闭用按钮,闭合手部12来握持传送物体11,另一方面,操作者再次按压手部开闭用按钮,打开手部12放开握持的传送物体11等。
关于异常判断单元49,被输入编码器8的输出q、压力传感器9的输出P和主控制部31的内部状态模型,作为输出测量单元的一例即编码器8 的异常判断单元发挥功能。
图11是异常判断单元49的详细的图,异常判断单元49由压力差计算单元51、内部状态模型比较单元52、和异常判断单元53构成。
关于压力差计算单元51,被输入各弹性膨胀收缩构造体1的压力P,计算在拮抗的一对弹性膨胀收缩构造体1的压力差ΔP,向内部状态模型比较单元52输出。
关于内部状态模型比较单元52,被输入作为压力差计算单元51的输出的压力差ΔP、作为编码器8的输出的关节角度q、和作为主控制部31内的内部状态模型数据库的输出的内部状态模型,对表示内部状态模型的压力差ΔP和关节角度q的关系的方程式、和当前的(进行比较动作时的)压力差的ΔP和当前的关节角度q的关系进行比较,求出编码器8的输出q以几%(百分之几)的程度错开内部状态模型的关节角度q,向异常判断单元53输出。
关于异常判断单元53,从表示编码器8的输出q以几%程度错开的内部状态模型比较单元52的输出,进行编码器8的输出q是否异常的判断,在异常的情况下,将异常检测信号向主控制部31输出。关于异常判断单元53中的是否异常的判断,例如,编码器8的输出q从内部状态模型的关节角度q错开了50%以上的情况被异常判断单元53判断为瞬时异常、编码器8的输出q从内部状态模型的关节角度q错开20%以上且低于50%的状态持续10秒以上的情况被判断为异常等,根据预先决定的条件进行判断。持续10秒以上可以由内置计时器进行测量。
关于基于以上的原理的正常时动作控制部32的控制程序的实际动作步骤,根据图12的流程图进行说明。
在步骤S1中,由编码器8测量的弹性体致动器驱动机构10的输出的测量值(关节角度q)被取入到控制装置30的正常时动作控制部32的异常判断单元49等中。
接着,在步骤S2中,由压力传感器9测量的弹性体致动器驱动机构10的内部状态的测量值(压力P)被取入到控制装置30的正常时动作控制部32的异常判断单元49等中。
接着,在步骤S3中,通过异常判断单元49,根据编码器8的输出q、 压力传感器9的输出P和主控制部31的内部状态模型,进行编码器8是否异常的判断。
以下,对在步骤S3中由异常判断单元49判断编码器8并非异常(正常)时进行说明。此时,从步骤S3进入步骤S4。
在步骤S4中,根据在目标轨道生成单元40内预先存储的弹性体致动器驱动机构10的动作程序,目标轨道生成单元40对弹性体致动器驱动机构10的输出的目标值(目标关节角度矢量qd)进行计算。
接着,在步骤S5中,以来自目标轨道生成单元40的输出和编码器8的输出q为基础,由输出误差计算部41求出角度误差矢量qe。此外,以输出误差计算部41的角度误差矢量qe为基础,角度误差补偿单元42对角度误差矫正指令值ΔPqe进行计算。
接着,在步骤S6中,以目标轨道生成单元40的目标关节角度矢量qd为基础,目标角加速度计算单元43对目标角加速度(下述[数12])进行计算。
[数12]
接着,步骤S7中,以目标角加速度计算单元43的目标角加速度(下述[数13])
[数13]
和角度误差补偿单元42的角度误差矫正指令值ΔPqe为基础,由矫正目标角加速度计算部44求出矫正目标角加速度(下述[数14])。
[数14]
然后,以矫正目标角加速度计算部44的矫正目标角加速度(下述[数15])
[数15]
和动态参数为基础,在正常时转矩控制单元45A进行目标压力值Pd的计算。
接着,在步骤S8中,以正常时转矩控制单元45A的目标压力值Pd为基础,在压力误差计算部46中计算压力误差Pe。此外,在压力误差补偿单元47中,由压力误差计算部46的压力误差Pe进行压力差误差矫正输出VΔpe即电压指令值的计算。
接着,在步骤S9中,向驱动装置50输出在压力误差补偿单元47中计算的电压指令值(压力差误差矫正输出VΔpe),通过驱动装置50对弹性体致动器驱动机构10进行驱动。
以上的步骤S1~步骤S9作为控制的计算环路被反复执行,由此实现了弹性体致动器驱动机构10的控制。
另一方面,以下对在步骤S3中判断为编码器8异常(不正常)时进行说明。此时,从步骤S3进入步骤S10。在步骤S10中,由异常判断单元49向主控制部31输出异常检测信号。
在通过执行以上的步骤S1~步骤S4、步骤10而检测到编码器8的异常的情况下,输出异常检测信号,向主控制部31发送异常检测信号,由此实现从正常时动作控制部32向异常时动作控制部33的控制部的切换。
图13是表示本发明的第一实施方式涉及的异常时动作控制部33的具体构成的图。异常时动作控制部33具有目标轨道生成单元(第二目标输出单元的一例)40、目标内部状态决定单元(第一目标内部状态算出单元)60、压力误差计算部46、压力误差补偿单元47、和握持物体信号输出单元48。
关于目标轨道生成单元40,发挥与正常时动作控制部32的目标轨道生成单元40相同的作用,所以省略说明。需要说明的是,下述的目标内部状态决定单元(第一目标内部状态算出单元)60,作为目标内部状态信息获得单元160的一例发挥功能。
关于目标内部状态决定单元60,从目标轨道生成单元40被输入目标关节角度矢量qd,由目标关节角度矢量qd算出目标压力差(压力差的目标值)ΔPd=[ΔP1d,ΔP2d]T。进而,通过目标内部状态决定单元60由目标压力差计算各弹性体致动器1的目标压力值Pd=[P1ad,P1bd,P2ad,P2bd]T,从目标内部状态决定单元60向目标内部状态误差计算部46输出。
图14是目标内部状态决定单元60的详细的图,由内部状态模型存储部61和目标压力计算单元62构成。
关于内部状态模型存储部61,如前所述从主控制部31向异常时动作控制部33输出。使用在该内部状态模型存储部61内存储的内部状态模型,由所输入的目标关节角度矢量qd计算各关节的弹性体致动器1的目标压力差ΔPd,向目标压力计算单元62输出。
关于目标压力计算单元62,由来自内部状态模型存储部61的目标压力差ΔPd计算各弹性体致动器1的目标压力值Pd,向握持物体信号输出单元48和目标内部状态决定单元60输出。为了由目标压力差ΔPd计算各弹性体致动器1的目标压力值Pd,目标压力计算单元62存储事先决定的1个条件、(例如,拮抗的2个弹性体致动器1的平均压力为300kPa,弹性体致动器1的压力差为200kPa等),由该条件和被输入的目标压力差ΔPd计算目标压力值Pd。例如,在关节轴6-1中,存储的条件是平均压力为250kPa,且目标压力差ΔPd为400kPa时,各弹性体致动器1的目标压力P1ad、P1bd有必要满足以下的式子。
[数16]
400=P1ad-P1bd
可以由以上的2个式子求出P1ad=450kPa、P1bd=50kPa。
返回图13,内部状态误差计算部46,从由目标内部状态决定单元60输出的弹性体致动器1的目标压力值Pd,减去由压力传感器9输出的压力P,算出压力误差ΔPe,向压力误差补偿单元47输出已算出的压力误差ΔPe。
关于基于以上的原理的控制程序的实际动作步骤,根据图15的异常时动作控制部的流程图进行说明。
在步骤S11中,根据在目标轨道生成单元40内预先存储的弹性体致动器驱动机构10的动作程序,目标轨道生成单元40对弹性体致动器驱动机构10的输出的目标值(目标角度qd)进行计算。
接着,在步骤S12中,由压力传感器9测量的弹性体致动器驱动机构10的内部状态的测量值(压力P)被取入到控制装置30的异常时动作控制部33的压力误差计算部46中。
接着,在步骤S13中,根据目标轨道生成单元40的目标关节角度矢量qd,通过目标内部状态决定单元60决定压力目标值Pd,向内部状态误差计算部46输出。
接着,在步骤S14中,目标内部状态决定单元60的压力目标值Pd与压力传感器9的当前的压力P之差、即压力误差ΔPe,由内部状态误差计算部46加以计算。此外,在压力误差补偿单元47中,由内部状态误差计算部46的压力误差ΔPe进行压力差误差矫正输出VΔpe即电压指令值的计算。
接着,在步骤S15中,向驱动装置50输出在压力误差补偿单元47中计算的电压指令值(压力差误差矫正输出VΔpe),通过驱动装置50对弹性体致动器驱动机构进行驱动。
以上的步骤S1~步骤S9作为控制的计算环路被反复执行,由此实现弹性体致动器驱动机构10的控制。
如上所示,上述第一实施方式的上述控制装置30具有:主控制部31、正常时动作控制部32和异常时动作控制部33,进而,在正常时动作控制部内31具有异常判断单元49。通过这样的构成,通过异常判断单元49判断编码器8是否正常,在异常判断单元49判断为编码器8不正常时,主控制部31进行从正常时动作控制部31向异常时动作控制部32的动作切换,由此,即便在编码器8发生了故障的情况下,也可以不会立即停止动作而可以继续动作的、安全的弹性体致动器驱动机构10的控制。
进而,使在异常时动作控制部33内的目标轨道生成单元40存储的目标角度矢量qdt为与在正常时动作控制部32内的目标轨道生成单元40存储的目标关节角度矢量qd不同的参数,例如,不是通常的传送物体11的搬运动作的重复,而设成将传送物体11传送至安全的位置,设置好传送 物体11之后,停止这样的目标关节角度矢量时,成为更安全的弹性体致动器驱动机构10的控制。
(第二实施方式)
对本发明的第二实施方式的弹性体致动器驱动机构10的控制装置30的具体构成的一例进行说明。
图16是表示本发明的第二实施方式涉及的异常时动作控制部33的具体构成的图。异常时动作控制部33具有目标轨道生成单元40、异常时转矩控制单元(第二目标内部状态信息算出单元)45B、目标角加速度计算单元43、压力误差计算部46、压力误差补偿单元47、角度推定单元(输出推定单元(输出推定部)的一例)65、和握持物体信号输出单元48。需要说明的是,由下述的角度推定单元(输出推定部)65和异常时转矩控制单元(第二目标内部状态信息算出单元)45B作为目标内部状态信息获得单元160的其他例发挥功能。
关于角度推定单元65,由从主控制部31输出的内部状态模型和从压力传感器9输出的弹性体致动器1的压力P求出作为关节角度的推定值的推定关节角度qest,向异常时转矩控制单元45B输出。关于推定的方法,通过角度推定单元65利用压力P求出关节的压力差ΔP,由角度推定单元65使用图6A以及图6B的方程式,由此通过角度推定单元65来推定关节角度。
例如,在未握持物体的状态下且在运转时间为10小时的情况下,向角度推定单元65输入通过以图6A的“◆”(黑菱形)的点表示的曲线图所示的表示关节角度q和压力差ΔP的关系的方程式作为内部状态模型。在输入的关节轴6-1的拮抗的一对弹性体致动器1-1a、1-1b各自的压力P1a、P1b为500kPa和300kPa的情况下,压力差ΔP=500-300=200,代入到方程式中时,由角度推定单元65推定关节角度q为20deg。
关于异常时转矩控制单元45B,由作为目标角加速度计算单元43的输出的目标角加速度(下述[数17])
[数17]
和动态参数,计算目标关节转矩τd,进而由目标关节转矩τd和输入的角度推定单元65的输出,计算相应的(关注的)关节的弹性体致动器1的目标压力值Pd。关于目标关节转矩τd和目标压力值Pd的算出方法,在前述的正常时转矩控制单元45A中的算出方法中,将矫正目标角加速度置换成目标角加速度,将关节角度q置换成推定关节角度qest,由此进行相同的计算。
关于上述异常时转矩控制单元45B,使用作为目标角加速度计算单元43的输出的目标角加速度作为输入,但目标角加速度在目标角加速度计算单元43中由作为目标轨道生成单元40(第二目标输出单元的一例)的输出的输出目标值算出。另外,上述角度推定单元65,利用从主控制部31输出的内部状态模型对角度进行推定。由此,由角度推定单元(输出推定部)65和异常时转矩控制单元45B构成目标内部状态信息获得单元160。
如上所示,就上述第二实施方式的上述控制装置30的异常时动作控制单元33而言,其与第一实施方式的异常时动作控制单元33的不同点在于,在第一实施方式的异常时动作控制单元33中,用作以关节角度为输入且以压力差为输出的内部状态模型,用作目标内部状态决定单元60,而上述第二实施方式的上述控制装置30的异常时动作控制单元33用作以压力差为输入且以关节角度为输出的内部状态模型,由此用作角度推定单元65。另外,上述控制装置30具有:主控制部31、正常时动作控制部32和异常时动作控制部33,进而在正常时动作控制部内32具有异常判断单元49而构成。通过这样的构成,由异常判断单元49判断编码器8是否正常,在由异常判断单元49判断编码器8不正常时,主控制部31进行从正常时动作控制部32向异常时动作控制部33的动作切换。进而,通过在异常时动作控制部33具有角度推定单元65,即便在编码器8发生了故障的情况下,也可以不立即停止动作而可以继续动作的、安全的弹性体致动器驱动机构10的控制。
需要说明的是,通过适当组合上述各种实施方式中的任意实施方式,可以发挥各自的效果。
【工业上的可利用性】
本发明的弹性体致动器驱动机构的控制装置以及控制方法、以及控制程序,用作进行通过弹性体致动器而动作的机器人手臂的手指位置的轨道控制等位置控制的控制装置以及控制方法、以及控制程序。另外,不限于机器人手臂,还可以用作生产设备等中的利用弹性体致动器的旋转机构的控制装置以及控制方法、以及控制程序、或线形滑块或加压装置等的利用弹性体致动器的直动机构的控制装置以及控制方法、以及控制程序。
本发明参照附图对优选的实施方式进行了充分记述,但对于熟悉该技术的人来说,自然会进行各种变形或矫正。这样的变形或矫正只要未超出基于技术方案的本发明的范围就应被理解为被本发明所包含。
Claims (7)
1.一种弹性体致动器驱动机构的控制装置,其中,具有:
异常判断单元,其判断对弹性体致动器的输出进行测量的输出测量单元是否异常,
正常时动作控制单元,其在由所述异常判断单元判断为所述输出测量单元正常时,利用来自所述输出测量单元的输出,进行所述弹性体致动器驱动机构的控制动作,
异常时动作控制单元,其在由所述异常判断单元判断为所述输出测量单元异常时,利用内部状态模型,进行所述弹性体致动器驱动机构的控制动作,和
控制部,其一方面,在所述异常判断单元判断所述输出测量单元为正常时使所述正常时动作控制单元进行动作,另一方面,在所述异常判断单元判断所述输出测量单元为异常时从所述正常时动作控制单元向所述异常时动作控制单元切换而使所述异常时动作控制单元进行动作;
所述正常时动作控制单元具有:
输出所述弹性体致动器输出的目标值的第一目标输出单元、和
利用所述第一目标输出单元的输出和来自所述输出测量单元的输出算出目标关节转矩的转矩控制单元,
所述正常时动作控制单元,根据由所述转矩控制单元算出的所述目标关节转矩,进行所述弹性体致动器驱动机构的控制动作;
并且,所述异常时动作控制单元具有:
输出所述弹性体致动器输出的目标值的第二目标输出单元、和
利用由所述第二目标输出单元输出的所述输出的目标值和所述内部状态模型获得所述弹性体致动器的目标内部状态信息的目标内部状态信息获得单元,
所述异常时动作控制单元,不使用所述弹性体致动器输出的测量结果,根据由所述目标内部状态信息获得单元获得的所述目标内部状态信息,进行所述弹性体致动器驱动机构的控制动作,由此控制所述弹性体致动器继续动作。
2.如权利要求1所述的控制装置,其中,
所述异常时动作控制单元的所述目标内部状态信息获得单元具有:利用由所述第二目标输出单元输出的所述输出的目标值和所述内部状态模型,算出目标内部状态信息的第一目标内部状态算出单元,根据由所述第一目标内部状态算出单元算出的所述目标内部状态信息进行所述弹性体致动器驱动机构的控制动作,由此控制所述弹性体致动器继续动作。
3.如权利要求1所述的控制装置,其中,
所述异常时动作控制单元的所述目标内部状态信息获得单元具有:
从所述内部状态模型和所述弹性体致动器的内部状态信息推定所述弹性体致动器的输出的输出推定部、和
从由所述输出推定部推定的所述弹性体致动器的输出和由所述第二目标输出单元输出的所述输出的目标值算出目标内部状态信息的第二目标内部状态信息算出单元,
根据利用由所述输出推定部推定的所述弹性体致动器的输出算出的所述目标内部状态信息,进行所述弹性体致动器驱动机构的控制动作,由此控制所述弹性体致动器继续动作。
4.如权利要求1所述的控制装置,其中,
所述异常判断单元,将来自所述输出测量单元的输出和来自对所述弹性体致动器的内部状态进行测量的内部状态测量单元的内部状态的关系的信息、与所述输出测量单元为正常时的内部状态模型的所述弹性体致动器的输出和所述弹性体致动器的内部状态的关系的信息加以比较,判断所述输出测量单元是否异常。
5.如权利要求1~4中任意一项所述的弹性体致动器驱动机构的控制装置,其中,
并且,所述异常时动作控制单元内的所述第二目标输出单元和所述正常时动作控制单元内的所述第一目标输出单元,输出所述弹性体致动器的不同输出的目标值,在所述异常时动作控制单元进行动作时,由所述异常时动作控制单元控制成所述弹性体致动器动作到安全的位置之后动作停止。
6.如权利要求1~4中任意一项所述的弹性体致动器驱动机构的控制装置,其中,
所述弹性体致动器是流体压力致动器。
7.一种弹性体致动器驱动机构的控制方法,其中,
由异常判断单元来判断对弹性体致动器的输出进行测量的输出测量单元是否异常,
一方面,在由所述异常判断单元判断为所述输出测量单元正常时,利用来自所述输出测量单元的输出,由正常时动作控制单元进行所述弹性体致动器驱动机构的控制动作,
另一方面,在由所述异常判断单元判断为所述输出测量单元异常时,利用内部状态模型,由异常时动作控制单元进行所述弹性体致动器驱动机构的控制动作,
并且,一方面,在所述异常判断单元判断所述输出测量单元为正常时,通过控制部使所述正常时动作控制单元进行动作,另一方面,在所述异常判断单元判断所述输出测量单元为异常时,通过所述控制部从所述正常时动作控制单元向所述异常时动作控制单元切换而使所述异常时动作控制单元进行动作,
一方面,在所述正常时动作控制单元进行动作时,
由第一目标输出单元输出所述弹性体致动器输出的目标值,
利用所述第一目标输出单元的输出和来自所述输出测量单元的输出,由转矩控制单元算出目标关节转矩,根据由所述转矩控制单元算出的所述目标关节转矩,进行所述弹性体致动器驱动机构的控制动作,
另一方面,在所述异常时动作控制单元进行动作时,
由第二目标输出单元输出所述弹性体致动器输出的目标值,
利用由所述第二目标输出单元输出的所述输出的目标值和所述内部状态模型,由目标内部状态信息获得单元获得所述弹性体致动器的目标内部状态信息,不使用所述弹性体致动器输出的测量结果,根据由所述目标内部状态信息获得单元获得的所述目标内部状态信息,进行所述弹性体致动器驱动机构的控制动作,由此控制所述弹性体致动器继续动作。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010-281167 | 2010-12-17 | ||
JP2010281167 | 2010-12-17 | ||
PCT/JP2011/006818 WO2012081197A1 (ja) | 2010-12-17 | 2011-12-06 | 弾性体アクチュエータ駆動機構の制御装置及び制御方法、並びに、制御プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103038030A CN103038030A (zh) | 2013-04-10 |
CN103038030B true CN103038030B (zh) | 2015-06-03 |
Family
ID=46244317
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201180036581.9A Expired - Fee Related CN103038030B (zh) | 2010-12-17 | 2011-12-06 | 弹性体致动器驱动机构的控制装置及控制方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8650868B2 (zh) |
JP (1) | JP5074640B2 (zh) |
CN (1) | CN103038030B (zh) |
WO (1) | WO2012081197A1 (zh) |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9566710B2 (en) | 2011-06-02 | 2017-02-14 | Brain Corporation | Apparatus and methods for operating robotic devices using selective state space training |
JP5907678B2 (ja) * | 2011-07-20 | 2016-04-26 | オリンパス株式会社 | 医療用動作機構およびマニピュレータ |
WO2013069291A1 (ja) * | 2011-11-10 | 2013-05-16 | パナソニック株式会社 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
US9764468B2 (en) | 2013-03-15 | 2017-09-19 | Brain Corporation | Adaptive predictor apparatus and methods |
JP6112947B2 (ja) * | 2013-04-08 | 2017-04-12 | キヤノン株式会社 | ロボット装置、ロボット制御方法、プログラム及び記録媒体 |
US9242372B2 (en) | 2013-05-31 | 2016-01-26 | Brain Corporation | Adaptive robotic interface apparatus and methods |
US9314924B1 (en) | 2013-06-14 | 2016-04-19 | Brain Corporation | Predictive robotic controller apparatus and methods |
US9792546B2 (en) | 2013-06-14 | 2017-10-17 | Brain Corporation | Hierarchical robotic controller apparatus and methods |
US9384443B2 (en) | 2013-06-14 | 2016-07-05 | Brain Corporation | Robotic training apparatus and methods |
US9579789B2 (en) | 2013-09-27 | 2017-02-28 | Brain Corporation | Apparatus and methods for training of robotic control arbitration |
CN108081268A (zh) * | 2013-10-10 | 2018-05-29 | 精工爱普生株式会社 | 机器人控制系统、机器人、程序以及机器人控制方法 |
US9597797B2 (en) | 2013-11-01 | 2017-03-21 | Brain Corporation | Apparatus and methods for haptic training of robots |
US9463571B2 (en) | 2013-11-01 | 2016-10-11 | Brian Corporation | Apparatus and methods for online training of robots |
US9358685B2 (en) * | 2014-02-03 | 2016-06-07 | Brain Corporation | Apparatus and methods for control of robot actions based on corrective user inputs |
US9682473B2 (en) * | 2014-08-29 | 2017-06-20 | Abb Schweiz Ag | Electric fluidic rotary joint actuator with pump |
US9630318B2 (en) | 2014-10-02 | 2017-04-25 | Brain Corporation | Feature detection apparatus and methods for training of robotic navigation |
US9717387B1 (en) | 2015-02-26 | 2017-08-01 | Brain Corporation | Apparatus and methods for programming and training of robotic household appliances |
US10471594B2 (en) * | 2015-12-01 | 2019-11-12 | Kindred Systems Inc. | Systems, devices, and methods for the distribution and collection of multimodal data associated with robots |
JP6739935B2 (ja) * | 2015-12-25 | 2020-08-12 | 株式会社東芝 | 駆動装置 |
DE102017000063B4 (de) * | 2016-01-14 | 2019-10-31 | Fanuc Corporation | Robotereinrichtung mit Lernfunktion |
US10241514B2 (en) | 2016-05-11 | 2019-03-26 | Brain Corporation | Systems and methods for initializing a robot to autonomously travel a trained route |
US9987752B2 (en) | 2016-06-10 | 2018-06-05 | Brain Corporation | Systems and methods for automatic detection of spills |
US10282849B2 (en) | 2016-06-17 | 2019-05-07 | Brain Corporation | Systems and methods for predictive/reconstructive visual object tracker |
US10016896B2 (en) | 2016-06-30 | 2018-07-10 | Brain Corporation | Systems and methods for robotic behavior around moving bodies |
WO2018079075A1 (ja) | 2016-10-24 | 2018-05-03 | パナソニックIpマネジメント株式会社 | エンコーダの異常検出方法及び異常検出装置、並びにロボット制御システム |
US10274325B2 (en) | 2016-11-01 | 2019-04-30 | Brain Corporation | Systems and methods for robotic mapping |
US10001780B2 (en) | 2016-11-02 | 2018-06-19 | Brain Corporation | Systems and methods for dynamic route planning in autonomous navigation |
US10723018B2 (en) | 2016-11-28 | 2020-07-28 | Brain Corporation | Systems and methods for remote operating and/or monitoring of a robot |
US10377040B2 (en) | 2017-02-02 | 2019-08-13 | Brain Corporation | Systems and methods for assisting a robotic apparatus |
US10852730B2 (en) | 2017-02-08 | 2020-12-01 | Brain Corporation | Systems and methods for robotic mobile platforms |
US10293485B2 (en) | 2017-03-30 | 2019-05-21 | Brain Corporation | Systems and methods for robotic path planning |
JP6948164B2 (ja) * | 2017-06-12 | 2021-10-13 | 日立Geニュークリア・エナジー株式会社 | 作業用ロボットのアーム姿勢制御システムおよび方法 |
CA3074666A1 (en) * | 2017-09-18 | 2019-03-21 | University Of Plymouth | Robotic arm |
CN108481318B (zh) * | 2018-03-07 | 2021-07-06 | 河南工业大学 | 基于散粒体阻塞理论的变刚度驱动杆及其工作系统 |
CN110385706B (zh) * | 2019-06-21 | 2021-10-19 | 清华大学 | 仿生力驱动装置及其控制方法 |
US11813033B2 (en) * | 2020-06-22 | 2023-11-14 | Michael Campagna | Medical imaging compatible radiolucent actuation of translation rotation articulation circumduction joint |
WO2022054947A1 (ja) * | 2020-09-14 | 2022-03-17 | 株式会社アイシン | ロボット装置およびその制御方法 |
KR102369005B1 (ko) * | 2020-09-25 | 2022-02-28 | 한국로봇융합연구원 | 로봇의 외력 정보를 이용 가능한 교시장치 및 제어방법 |
WO2024134865A1 (ja) * | 2022-12-23 | 2024-06-27 | 憲太 北村 | ソフトロボット |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1964180A (zh) * | 2005-11-08 | 2007-05-16 | 欧姆龙株式会社 | 电机控制装置 |
JP4563512B2 (ja) * | 2009-01-13 | 2010-10-13 | パナソニック株式会社 | 弾性体アクチュエータの制御装置及び制御方法、並びに、制御プログラム |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0727411B2 (ja) * | 1984-10-31 | 1995-03-29 | 株式会社日立製作所 | 駆動装置 |
JPS62212710A (ja) * | 1986-03-14 | 1987-09-18 | Agency Of Ind Science & Technol | 移動型ロボツトの移動制御装置 |
JPH02204805A (ja) * | 1989-02-02 | 1990-08-14 | Toshiba Corp | 追従制御装置 |
JPH0336782A (ja) | 1989-07-04 | 1991-02-18 | Fujitsu Ltd | 集積回路装置 |
JPH081819Y2 (ja) * | 1989-08-23 | 1996-01-24 | 豊田工機株式会社 | ロボット制御装置 |
JPH0555279A (ja) | 1991-08-29 | 1993-03-05 | Mitsumi Electric Co Ltd | 半導体の製造方法 |
JP3394599B2 (ja) | 1994-06-27 | 2003-04-07 | 株式会社ブリヂストン | 空気入りラジアルタイヤの製造方法 |
JP3844167B2 (ja) * | 1998-02-27 | 2006-11-08 | 新キャタピラー三菱株式会社 | サーボ弁 |
WO2005028166A1 (ja) * | 2003-09-22 | 2005-03-31 | Matsushita Electric Industrial Co., Ltd. | 弾性体アクチュエータの制御装置及び制御方法 |
JP2008121783A (ja) * | 2006-11-13 | 2008-05-29 | Japan Science & Technology Agency | 関節システム |
WO2009098855A1 (ja) * | 2008-02-06 | 2009-08-13 | Panasonic Corporation | ロボット、ロボットの制御装置及び制御方法、並びに、ロボットの制御装置の制御プログラム |
KR101479234B1 (ko) | 2008-09-04 | 2015-01-06 | 삼성전자 주식회사 | 로봇 및 그 제어 방법 |
US8359849B2 (en) * | 2009-04-07 | 2013-01-29 | Eaton Corporation | Control of a fluid circuit using an estimated sensor value |
WO2011086638A1 (ja) | 2010-01-15 | 2011-07-21 | パナソニック株式会社 | 弾性体アクチュエータ駆動機構の制御装置及び制御方法、並びに、制御プログラム |
-
2011
- 2011-12-06 CN CN201180036581.9A patent/CN103038030B/zh not_active Expired - Fee Related
- 2011-12-06 JP JP2012524993A patent/JP5074640B2/ja active Active
- 2011-12-06 WO PCT/JP2011/006818 patent/WO2012081197A1/ja active Application Filing
-
2012
- 2012-09-13 US US13/613,221 patent/US8650868B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1964180A (zh) * | 2005-11-08 | 2007-05-16 | 欧姆龙株式会社 | 电机控制装置 |
JP4563512B2 (ja) * | 2009-01-13 | 2010-10-13 | パナソニック株式会社 | 弾性体アクチュエータの制御装置及び制御方法、並びに、制御プログラム |
Also Published As
Publication number | Publication date |
---|---|
JP5074640B2 (ja) | 2012-11-14 |
US8650868B2 (en) | 2014-02-18 |
CN103038030A (zh) | 2013-04-10 |
WO2012081197A1 (ja) | 2012-06-21 |
US20130000480A1 (en) | 2013-01-03 |
JPWO2012081197A1 (ja) | 2014-05-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103038030B (zh) | 弹性体致动器驱动机构的控制装置及控制方法 | |
CN102132048B (zh) | 弹性体致动器的控制装置及控制方法、控制程序 | |
CN102781633A (zh) | 弹性体致动器驱动机构的控制装置及控制方法、以及控制程序 | |
CN102026783B (zh) | 机器人、机器人的控制装置、控制方法及控制程序 | |
US7184858B2 (en) | Apparatus and method for controlling elastic actuator | |
US20200086087A1 (en) | Torque-based catheter articulation | |
US7445260B2 (en) | Gripping type hand | |
CN103025492B (zh) | 机器人的控制装置以及控制方法、机器人 | |
CN104302454A (zh) | 机器人 | |
CN108698223A (zh) | 机器人关节和具有至少一个这种机器人关节的机器人 | |
US20140116826A1 (en) | Railcar damping device | |
CN100421886C (zh) | 弹性体驱动器的控制装置及控制方法 | |
Wolbrecht et al. | Pneumatic control of robots for rehabilitation | |
CN101541484A (zh) | 压缩性流体压力促动器驱动机构及其控制装置 | |
Tödtheide et al. | Antagonistic impedance control for pneumatically actuated robot joints | |
CN108240374A (zh) | 用于电气动现场仪器的调整和/或控制方法 | |
WO2008034154A1 (de) | Vorrichtung zum steuern eines roboterarmes | |
CN202878079U (zh) | 一种用于气囊抛光的接触力实时控制系统 | |
US20210146527A1 (en) | Exoskeleton joint drive with non-linear transmission | |
Schindele et al. | Trajectory tracking of a pneumatically driven parallel robot using higher-order SMC | |
Aschemann et al. | Sliding mode control for a high-speed linear axis driven by pneumatic muscles | |
JP6779933B2 (ja) | ロボット | |
JP2008290671A (ja) | 車体傾斜制御装置 | |
CN107160372A (zh) | 仿生机械臂 | |
WO2012049130A1 (en) | Methods of and apparatuses for balancing electrode arms of a welding device taking into account spatial orientation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150603 |