CN109635474B - 提高在机械臂抓握行为中构建加性成本函数通用性的方法 - Google Patents
提高在机械臂抓握行为中构建加性成本函数通用性的方法 Download PDFInfo
- Publication number
- CN109635474B CN109635474B CN201811557829.6A CN201811557829A CN109635474B CN 109635474 B CN109635474 B CN 109635474B CN 201811557829 A CN201811557829 A CN 201811557829A CN 109635474 B CN109635474 B CN 109635474B
- Authority
- CN
- China
- Prior art keywords
- finger
- cost function
- mechanical arm
- rigid object
- experimental data
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/17—Mechanical parametric or variational design
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/21—Design or setup of recognition systems or techniques; Extraction of features in feature space; Blind source separation
- G06F18/213—Feature extraction, e.g. by transforming the feature space; Summarisation; Mappings, e.g. subspace methods
- G06F18/2135—Feature extraction, e.g. by transforming the feature space; Summarisation; Mappings, e.g. subspace methods based on approximation criteria, e.g. principal component analysis
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Data Mining & Analysis (AREA)
- General Engineering & Computer Science (AREA)
- Evolutionary Computation (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Evolutionary Biology (AREA)
- Bioinformatics & Computational Biology (AREA)
- Artificial Intelligence (AREA)
- Life Sciences & Earth Sciences (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Computer Hardware Design (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种提高在机械臂抓握行为中构建加性成本函数通用性的方法。本发明首先让臂抓住刚性物体并将其保持在空气中静止,刚性物体被施加各种外部扭矩,载荷;然后,使用ANIO方法确定基本的成本函数类型,并从所有试验记录的实验数据中,确定出4维手指力空间中的二维超平面上的趋势;最后,根据拉格朗日原理,调节成本函数类型参数,使得实验观察的平面接近由直接优化产生的平面,最终为机械臂成功地重建了成本函数。本发明利用ANIO方法可以在任意的五指型机械臂中重构成本函数,实现机械的高效精准抓取和路径最优规划。
Description
技术领域
本发明属于工业自动控制领域,涉及一种提高构建五指型机械臂成本函数的通用性方法。
背景技术
人体手臂抓握物体通常具有良好的可重复性,它们在人与人之间略有不同。这种一致性反映了这样一个事实:人类试图以最“舒适”的方式执行他们的行为,从某种意义上说这种方式在性能上是最优的。
多指机械臂抓握中手指之间的力分布是在并行的电机之间分配输入的一般问题的一个特例,这种问题的一般描述是假设一组肌肉共同连接一组手指关节,那么如何让肌肉的分配最优化。
当机器臂五指握住物体时,保持物体静止不动的任务是高度冗余的:在5指抓握物体中,有30个变量需要控制(每个手指有3个分力和3个力矩分量,一共5个手指),而空间中的刚性物体只有6个自由度。目前用于机械臂抓取的成本函数大部分采用大范围搜索寻找一个合适的成本函数,即随机选择函数来验证实验数据,如果预测值与实验值一致,则认定成本函数是成功的,否则重新选择。上述方法在机械臂的多指抓取问题中,已成功获取了几种较好的成本函数。能使部分目标函数的预测与实验数据有很好的一致性,但这些目标函数的获取都是基于研究人员的猜测。目前并没有可以直接从实验数据中直接找出成本函数的逆优化方法,并且这种方法盲目性大、损耗资源。
发明内容
本发明目的是针对五指型机械臂抓握物体的路径规划问题,改善构建成本函数的通用性,提出了根据实验数据逆优化来构建成本函数的方法。本发明根据机械臂数据,比如臂长,刚性物体重量和扭矩等,采用逆优化理论中ANIO方法,来构建成本函数。不同于直接优化问题,这个问题通常被称为逆优化问题,在逆优化中,目标函数是未知的,而目标函数达到其最小值的值是给出的。在本发明中,关注具有加性目标函数和线性约束的逆优化问题,通过逆优化方法,可以快速高效地构建五指型机械臂的抓握行为的成本函数,从而实现五指型机械臂抓握物体的路劲最优化。
本发明目的技术方案是通过数据采集、模型建立,构建成本函数、优化参数等手段,确立了一种为五指型机械臂抓握过程的成本函数构建方法,利用该方法可以快速高效地构建成本函数实现五指型机械臂抓握行为的路径最优化。
本发明的方法步骤包括:
步骤一:建立人体抓握模型。
该模型描述如下:
其中是手指力向量是4×1非负值(下标in,mi,ri和li分别代表食指,中间,无名指和小指),J是成本函数标量值,上标n表示法向力,gi是相应指力的标量函数,是四指法向力的总和,Y=[Yin,Ymi,Yri,Yli]T代表法向手指力的力矩臂,Mn是刚性物体被施加的外力矩。约束可写为CF=B。
步骤二:确定问题是否可分为子问题。
步骤三:应用ANIO定理。
则可以获得以下公式:
fi′(Fi n)=kiFi n+wi
其中,ki和wi是常数,i∈{in,mi,ri,li}。
因此
其中fi(Fi n)表示每个手指对应的目标函数类。
步骤四:构建实验数据形成的超二维平面。
固定刚性物体的重量和扭矩,构成向量b,对实验者进行N组实验,则得到N组C矩阵和F矩阵,采用主城分析法(PCA)将N组C矩阵降维到2个主成分,构成2×4矩阵A。
则在每一组实验中由数据得到的超平面可以定义为:
AF=b
步骤五:优化参数ki和wi的值。
将通过实验数据导出超平面与从唯一性定理导出的超平面进行比较,可以最小化上述两个平面之间的二面角来数值计算ki的值:(i)最优解的平面,即其中K=diag[kin,kmi,kri,kli]和W=[win,wmi,wri,wli]T;(ii)实验数据形成的平面,即AF=b。则得到
步骤六:根据步骤一到五求期望的目标函数。
目标函数是:
假设r=1,consti=0,qi=0,于是可得实验者抓握的成本函数为:
本发明具有的有益效果为:
1、提出了构建五指型机械臂抓握行为中成本函数构建通用性的方法。针对任意的多手指型机械臂问题,或者任意的N个电机共享M(N>M)个关节的机械问题,可以根据实验数据快速构建相应的成本函数。
2、实现了机械臂抓握行为的路径最优化。可以做到对于任意的刚性物体,机械臂以模仿人类手臂的姿势去躲避障碍物,然后“最优化”地抓取此刚性物体。
具体实施方式
以五指型机械臂抓握问题为例:
步骤一:建立五指型机械臂抓握刚性物体的物理模型。
所研究抓握问题的静态平衡条件应该满足三个等式约束(平衡水平、垂直方向上的外力和平衡施加到刚性物体的外力矩)和两个不等式约束(法向力应该足够大以防止物体从手上滑落,手指力是非负的并且不能大于最大手指力量)。
其中是手指力向量是4×1非负值(下标in,mi,ri和li分别代表食指,中间,无名指和小指),J是成本函数标量值,上标n表示法向力,gi是相应指力的标量函数,是四指法向力的总和,Y=[Yin,Ymi,Yri,Yli]T代表法向手指力的力矩臂,Mn是刚性物体被施加的外力矩。约束可写为CF=B。
步骤二:确定抓握问题是否可分为子问题。
步骤三:对机械臂抓握问题应用ANIO定理。
由于满足上述等式的任意一个自变量F值,必须在约束CF=B形成的四维指力(除去拇指)空间的二维超平面上,这要求,fi′(Fi n)应该是Fi n的线性函数。则可以获得以下公式:
fi′(Fi n)=kiFi n+wi
其中,ki和wi是常数,i∈{in,mi,ri,li}。
因此
其中fi(Fi n)表示每个手指对应的目标函数类。
步骤四:构建机械臂抓握实验数据形成的超二维平面。
固定刚性物体的重量和扭矩,对机械臂进行N组抓握实验,则可以得到N组C矩阵和F矩阵,采用主城分析法(PCA)将N组C矩阵降维到2个主成分,构成2×4矩阵A。
则在每一组实验中由数据得到的超平面可以定义为:
AF=b
步骤五:优化参数机械臂抓握模型参数ki和wi的值。
将通过实际机械臂抓握实验数据导出超平面与从唯一性定理导出的超平面进行比较,可以最小化上述两个平面之间的二面角来数值计算ki的值:
其中K=diag[kin,kmi,kri,kli]和W=[win,wmi,wri,wli]T;
(ii)实验数据形成的平面,即AF=b。
此时,实验平面和最优解的平面最接近。
步骤六:求期望的目标函数。
目标函数是:
如果人为的假设r=1,consti=0,qi=0,于是可得机械臂抓握的成本函数为:
步骤七:将此成本函数应用于控制器中。
将此成本函数模型输入到控制器中,实现机械臂抓取刚性物体行为的路径最优化。如果有偏差,则再次重复步骤四到步骤六,直达消除误差,使得实验超平面和最优解超平面完全一致。
Claims (1)
1.提高在机械臂抓握行为中构建加性成本函数通用性的方法,其特征在于该方法包括以下步骤:
步骤一:建立人体抓握模型,该模型描述如下:
其中是手指力向量是4×1非负值,下标in,mi,ri和li分别代表食指,中间,无名指和小指,J是成本函数标量值,上标n表示法向力,gi是相应指力的标量函数,是四指法向力的总和,Y=[Yin,Ymi,Yri,Yli]T代表法向手指力的力矩臂,Mn是刚性物体被施加的外力矩;约束可写为CF=B;
步骤二:确定问题是否可分为子问题;
步骤三:应用ANIO定理;
则可以获得以下公式:
其中,ki和wi是常数,i∈{in,mi,ri,li};
因此
其中fi(Fi n)表示每个手指对应的目标函数类;
步骤四:构建实验数据形成的超二维平面;
固定刚性物体的重量和扭矩,构成向量b,对实验者进行N组实验,则得到N组C矩阵和F矩阵,采用主城分析法将N组C矩阵降维到2个主成分,构成2×4矩阵A;
则在每一组实验中由数据得到的超平面可以定义为:
AF=b
步骤五:优化参数ki和wi的值;
将通过实验数据导出超平面与从唯一性定理导出的超平面进行比较,最小化上述两个平面之间的二面角来数值计算ki的值:
步骤六:根据步骤一到五求期望的目标函数;
目标函数是:
假设r=1,consti=0,qi=0,于是可得实验者抓握的成本函数为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811557829.6A CN109635474B (zh) | 2018-12-19 | 2018-12-19 | 提高在机械臂抓握行为中构建加性成本函数通用性的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811557829.6A CN109635474B (zh) | 2018-12-19 | 2018-12-19 | 提高在机械臂抓握行为中构建加性成本函数通用性的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109635474A CN109635474A (zh) | 2019-04-16 |
CN109635474B true CN109635474B (zh) | 2023-04-28 |
Family
ID=66075452
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811557829.6A Active CN109635474B (zh) | 2018-12-19 | 2018-12-19 | 提高在机械臂抓握行为中构建加性成本函数通用性的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109635474B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1989011257A1 (en) * | 1988-05-23 | 1989-11-30 | Augspurger Lynn L | Method and system for making prosthetic device |
WO2001080761A2 (en) * | 2000-04-19 | 2001-11-01 | Orametrix, Inc. | Interactive orthodontic care system based on intra-oral scanning of teeth |
CN107225576A (zh) * | 2017-07-31 | 2017-10-03 | 哈工大机器人集团有限公司 | 一种基于软性手指的控制方法 |
CN107490965A (zh) * | 2017-08-21 | 2017-12-19 | 西北工业大学 | 一种空间自由漂浮机械臂的多约束轨迹规划方法 |
CN108015763A (zh) * | 2017-11-17 | 2018-05-11 | 华南理工大学 | 一种抗噪声干扰的冗余度机械臂路径规划方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8731880B2 (en) * | 2010-09-14 | 2014-05-20 | University Of Washington Through Its Center For Commercialization | Invertible contact model |
-
2018
- 2018-12-19 CN CN201811557829.6A patent/CN109635474B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1989011257A1 (en) * | 1988-05-23 | 1989-11-30 | Augspurger Lynn L | Method and system for making prosthetic device |
WO2001080761A2 (en) * | 2000-04-19 | 2001-11-01 | Orametrix, Inc. | Interactive orthodontic care system based on intra-oral scanning of teeth |
CN107225576A (zh) * | 2017-07-31 | 2017-10-03 | 哈工大机器人集团有限公司 | 一种基于软性手指的控制方法 |
CN107490965A (zh) * | 2017-08-21 | 2017-12-19 | 西北工业大学 | 一种空间自由漂浮机械臂的多约束轨迹规划方法 |
CN108015763A (zh) * | 2017-11-17 | 2018-05-11 | 华南理工大学 | 一种抗噪声干扰的冗余度机械臂路径规划方法 |
Non-Patent Citations (1)
Title |
---|
孙瑛 ; 苗卫 ; 李公法 ; 孔建益 ; 蒋国璋 ; 熊禾根 ; 郭永兴 ; 何洋 ; 李贝 ; .机器人多指抓取最优规划的研究现状和发展趋势.长江大学学报(自科版).2016,(第01期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN109635474A (zh) | 2019-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lv et al. | An assembly sequence planning approach with a discrete particle swarm optimization algorithm | |
Chen et al. | A hybrid strategy for the time-and energy-efficient trajectory planning of parallel platform manipulators | |
CN110076783A (zh) | 一种基于模糊控制和李雅普诺夫函数的平面欠驱动机械臂位置控制方法 | |
Zhu et al. | An efficient numerical method for forward kinematics of parallel robots | |
Amar et al. | Genetic-algorithm-based global design optimization of tree-type robotic systems involving exponential coordinates | |
Kazeminasab et al. | Design Parallel Fuzzy Partly Inverse Dynamic Method plus Gravity Control for Highly Nonlinear Continuum Robot | |
Jiang | A hybrid grey wolf optimization for job shop scheduling problem | |
Zakaria et al. | Robotic control of the deformation of soft linear objects using deep reinforcement learning | |
Bongard | Innocent until proven guilty: Reducing robot shaping from polynomial to linear time | |
CN109635474B (zh) | 提高在机械臂抓握行为中构建加性成本函数通用性的方法 | |
Zhao et al. | Path planning of manipulator based on RRT-Connect and Bezier curve | |
Wu et al. | Multi-objective configuration optimization of assembly-level reconfigurable modular robots | |
Tahara et al. | Reaching movements of a redundant musculoskeletal arm: Acquisition of an adequate internal force by iterative learning and its evaluation through a dynamic damping ellipsoid | |
Das et al. | Control of a scara robot: pso-pid approach | |
Nagata et al. | Neural network-based inverse kinematics for an industrial robot and its learning method | |
Du et al. | Adaptive fuzzy sliding mode control algorithm simulation for 2-DOF articulated robot | |
Tahara et al. | Iterative learning scheme for a redundant musculoskeletal arm: Task space learning with joint and muscle redundancies | |
Li et al. | Optimal design and control of smart space structures: a memetic evolution approach | |
Xu et al. | GA-based architecture optimization of a 3-PUU parallel manipulator for stiffness performance | |
Bednarek et al. | Comparative assessment of reinforcement learning algorithms in the taskof robotic manipulation of deformable linear objects | |
Zhu et al. | Inertia parameter identification of robot arm based on BP neural network | |
Chang et al. | Parameter identification of nonlinear systems using a particle swarm optimization approach | |
Minatohara et al. | Self-organizing adaptive controllers: Application to the inverted pendulum | |
Zhang et al. | Configuration synthesis of underactuated resilient robotic systems | |
Wang et al. | Hybrid controllers for two-link flexible manipulators |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |