一种臂架系统控制方法、臂架控制系统及臂架设备.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN106585578A(43)申请公布日2017.04.26(21)申请号201611142454.8(22)申请日2016.12.12(71)申请人三一汽车制造有限公司地址410100湖南省长沙市经济技术开发区三一工业城(72)发明人易秀明徐国荣赵雄石祥(74)专利代理机构北京友联知识产权代理事务所(普通合伙)11343代理人尚志峰汪海屏(51)Int.Cl.B60S9/02(2006.01)G05D3/12(2006.01)权利要求书2页说明书9页附图6页(54)发明名称一种臂架系统控制方法、臂架控制系统及臂架设备(57)摘要本发明提出了一种臂架系统控制方法、臂架控制系统及臂架设备，该方法包括以下步骤：在各个支腿的活动范围内，将每个支腿的活动范围划分为多个活动区间，根据各个支腿在不同活动区间的组合，建立支撑档位库，在支撑档位库中确定了在每一个支撑档位下，臂架系统在不同的回转角度下，臂架系统的允许活动范围；检测各个支腿的实际支撑状态，实际支撑状态包括各个支腿实际的伸出长度和/或展开角度；根据检测到的各个支腿的实际支撑状态，在支撑档位库中查找与各个支腿的实际支撑状态相对应的支撑档位，从而确定出臂架系统在不同的回转角度下的允许活动范围，并据此控制臂架系统的运动。该方法不需要时刻计算整车的重心，计算量小，控制出错率低。CN106585578ACN106585578A权利要求书1/2页1.一种臂架系统控制方法，用于控制由多个支腿支撑的臂架系统，所述臂架系统包括多个臂节，其特征在于，包括以下步骤：步骤102：在各个支腿的活动范围内，将每个支腿的活动范围划分为多个活动区间，根据各个支腿在不同活动区间的组合，建立支撑档位库，在所述支撑档位库中确定了在每一个支撑档位下，所述臂架系统在不同的回转角度下，所述臂架系统的允许活动范围；步骤104：检测各个支腿的实际支撑状态，所述实际支撑状态包括各个支腿实际的伸出长度和/或展开角度；步骤106：根据检测到的各个支腿的实际支撑状态，在支撑档位库中查找与各个支腿的实际支撑状态相对应的支撑档位，从而确定出所述臂架系统在不同的回转角度下的允许活动范围，并据此控制所述臂架系统的运动。2.根据权利要求1所述的臂架系统控制方法，其特征在于，在步骤102中，所述臂架系统的允许活动范围包括所述臂架系统的至少一个臂节的重心变化范围和/或各臂节允许的变幅角度范围或伸缩长度范围。3.根据权利要求2所述的臂架系统控制方法，其特征在于，所述臂架系统包括依次连接的第1臂节、第2臂节、……、第N臂节，N为大于1的整数，在步骤102中，所述臂架系统的允许活动范围为各臂节允许的变幅角度范围或伸缩长度范围；在步骤106中，控制所述臂架系统的运动时，依次限制第1臂节、第2臂节、……、第N臂节在允许的变幅角度或伸缩长度范围内运动。4.根据权利要求3所述的臂架系统控制方法，其特征在于，在步骤102中，所述臂架系统在不同的回转角度且在每一的支撑档位下，确定第1臂节允许的变幅角度或伸缩长度范围时，假定第2臂节、……、第N臂节位于水平状态或最大伸出状态；确定第2臂节允许的变幅角度或伸缩长度范围时，假定第3臂节、……、第N臂节位于水平状态或最大伸出状态；……；确定第N-1臂节允许的变幅角度或伸缩长度范围时，假定第N臂节位于水平状态或最大伸出状态。5.根据权利要求1至4中任一项所述的臂架系统控制方法，其特征在于，在步骤102中，根据各个支腿中相邻两支腿在不同活动区间的组合，确定多个支撑区间，所述支撑档位包括与多个支撑区间对应的多个支撑分档，所述支撑分档确定了所述臂架系统回转至该支撑区间内时，所述臂架系统的允许活动范围；在步骤106中，根据各个支腿的实际支撑状态，在支撑档位库中查找出与该实际支撑状态等效的位于各个支撑区间的支撑分档，从而确定所述臂架系统在不同的回转角度下，所述臂架系统的允许活动范围。6.根据权利要求5所述的臂架系统控制方法，其特征在于，在步骤102中，在各个支腿的活动范围内选取多个分割点，每个支腿上相邻两个分割点之间的范围构成一个活动区间，每个活动区间的靠近臂架回转中心的分割点为内分隔点，每个活动区间的远离臂架回转中心的分割点为外分隔点；相邻两支腿中其中一个支腿的第一活动区间与臂架系统的回转中心的连线、另一个支腿的第二活动区间与臂架系统的回转中心的连线构成的范围为支撑区间，第一活动区间的内分隔点、外分隔点与第二活动区间的内分隔点、外分隔点之间的4条连线为支撑档位线，每一支撑档位线对应一个支撑分档，并确定在每一个支撑分档下，所述臂架系统在该支撑区间时，所述臂架系统的允许活动范围；在步骤106中，查找与该实际支撑状态等效的位于各个支撑区间的支撑分档时，选择4条支撑档位