高级检索

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

步进式横向插刀机构的运动学求解与轨迹规划

隋婷婷 刘晋浩 唐伟国

隋婷婷, 刘晋浩, 唐伟国. 步进式横向插刀机构的运动学求解与轨迹规划[J]. 北京林业大学学报, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
引用本文: 隋婷婷, 刘晋浩, 唐伟国. 步进式横向插刀机构的运动学求解与轨迹规划[J]. 北京林业大学学报, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
SUI Ting-ting, LIU Jin-hao, TANG Wei-guo. Kinematics solution and trajectory planning of stepping transverse slotting mechanism[J]. Journal of Beijing Forestry University, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
Citation: SUI Ting-ting, LIU Jin-hao, TANG Wei-guo. Kinematics solution and trajectory planning of stepping transverse slotting mechanism[J]. Journal of Beijing Forestry University, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213

步进式横向插刀机构的运动学求解与轨迹规划

doi: 10.13332/j.1000-1522.20170213
基金项目: 

国家科技支撑计划项目 2015BAD07B00

详细信息
    作者简介:

    隋婷婷,博士生。主要研究方向:森林工程及其自动化。Email:296654017@qq.com   地址:100083 北京市海淀区清华东路35号北京林业大学工学院

    通讯作者:

    刘晋浩,教授,博士生导师。主要研究方向:林业与环境特种装备的研制与开发。Email:liujinhao@vip.163.com   地址:同上

  • 中图分类号: S776

Kinematics solution and trajectory planning of stepping transverse slotting mechanism

  • 摘要: 根据机构学原理,提出一种多杆步进式并联横向插草机构。通过Matlab软件求解运动学模型得到插刀机构标记点插草过程中连续变化的曲线, 利用fsolve函数进行插刀标记点的轨迹规划,借助Creo2.0对步进式插刀机构进行三维建模,并在ADAMS中对插刀机构作业时常设置的纵向宽900、1 000和1 100 mm这3种情况进行运动仿真,通过标记点P的运动轨迹分析步进式插刀机构的作业性能。结果表明:与旋转式插刀相比,步进式插刀机构具有良好的作业效率与精度,且操作灵活,能够满足铺设草方格的作业要求。
  • 图  1  横向插草系统原理图

    1.横向输送草机构; 2.横向推草机构; 3.多杆步进式并联插刀机构; 4.干草; 5.沙地。

    Figure  1.  Transverse insert straw system

    1.Transverse conveyance mechanism; 2.Transverse pushing mechanism; 3.Multi rod stepping type parallel slotting mechanism; 4.Straw; 5.Sandland.

    图  2  草沙障示意图

    b为草沙障的宽度; h为草沙障的插入深度。

    Figure  2.  Sketch map of straw barrier

    b is the width of straw barrier, and h is the insertion depth of straw barrier.

    图  3  多杆步进式并联插刀机构

    1和2为对称六杆机构。

    Figure  3.  Multi rod stepping type parallel slotting mechanism

    1 and 2 are the symmetrical six rod mechanisms.

    图  4  多杆步进式并联插刀机构运动学模型

    L0:杆件OD长度,mm;θ0ODx轴夹角, °;L1:杆件OB长度,mm;θ1OBx轴夹角,°;L2:杆件BC长度,mm,L7:杆件CG长度,mm;θ2BGx轴夹角,°;L3:杆件CD长度,mm;θ3CDx轴的夹角,°;L4:杆件OE长度,mm;θ4OEx轴的夹角,°;L5:杆件EF长度,mm;θ5EFx轴的夹角,°;L6:杆件FG长度,mm;L8:杆件GP长度,mm;δFGGP夹角,°;θ6FGx轴夹角,°。

    Figure  4.  Kinematics model of multi rod stepping parallel slotting mechanism

    L0 is the length of rod OD, mm; θ0 is the angle between OD and x-axis, °; L1 is the length of rod OB, mm; θ1 is the angle between OB and x-axis, °; L2 is the length of part BC, mm; L7 is the length of part CG, mm; θ2 is the angle between BG and x-axis, °; L3 is the length of rod CD, mm; θ3 is the angle between CD and x-axis, °; L4 is the length of rod OE, mm; θ4 is the angle between OE and x-axis, °; L5 is the length of rod EF, mm; θ5 is the angle between EF and x-axis, °; L6 is the length of part FG, mm; L8 is the length of rod GP, mm; δ is the angle between FG and GP, °; and θ6 is the angle between FG and x-axis, °.

    图  5  多杆步进式并联插刀机构角运动学求解

    Figure  5.  Kinematics solution of mechanism angle of multi rod stepping type parallel slotting mechanism

    图  6  插刀顶端标注点P运动轨迹

    Figure  6.  Motion path of point P marked on the top of slotting mechanism

    图  7  不同杆长取值下插刀顶端标注点P的运动轨迹变化

    Figure  7.  Motion path of point P marked on the top of slotting mechanism varies with rod length

    图  8  插刀顶端标注点Pθ0θ4不同取值下的运动轨迹

    Figure  8.  8 Motion path of point P varies with θ0 and θ4

    图  9  插刀顶端标注点Pθ4不同取值下的运动轨迹

    Figure  9.  Motion path of point P varies with θ4

    图  10  插刀顶端标注点Pδ不同取值下的运动轨迹

    Figure  10.  10 Motion path of point P varies with δ

    图  11  Matlab仿真插刀顶端标注点P轨迹

    Figure  11.  Matlab simulation of motion path of the point P marked on the slotting tool

    图  12  插刀顶端标注点P运动轨迹的ADAMS仿真

    Figure  12.  ADAMS simulation of motion path of the point P marked on the slotting tool

  • [1] 李跃娟.草方格铺设机器人横向气动插草机构动力学仿真分析[D].哈尔滨: 东北林业大学, 2005. http://cdmd.cnki.com.cn/Article/CDMD-10225-2005136692.htm

    LI Y J. Dynamic simulation of pneumatic transverse paving mechanism in paving straw robot[D].Harbin: Northeast Forestry University, 2005. http://cdmd.cnki.com.cn/Article/CDMD-10225-2005136692.htm
    [2] 刘晋浩, 李跃娟, 齐巍.横向插草机构回位装置的优化设计[J].林业机械与木工设备, 2004, 32(9):31-32. doi:  10.3969/j.issn.2095-2953.2004.09.011

    LIU J H, LI Y J, QI W.Optimum design of return mechanism of transverse insertion mechanism[J].Forestry Machinery & Woodworking Equipment, 2004, 32(9):31-32. doi:  10.3969/j.issn.2095-2953.2004.09.011
    [3] 陆怀民, 郭秀荣, 赵志国, 等.防风固沙草方格铺设机器人沙漠通过性研究[J].中国工程机械学报, 2006, 4(4):389-393. doi:  10.3969/j.issn.1672-5581.2006.04.003

    LU H M, GUO X R, ZHAO Z G, et al. Desert trafficability study of trellis grass paving robot[J].Chinese Journal of Construction Machinery, 2006, 4(4):389-393. doi:  10.3969/j.issn.1672-5581.2006.04.003
    [4] 刘晋浩, 舒庆.草方格铺设机器人虚拟样机建模及平顺性分析[J].北京林业大学学报, 2007, 29(4):72-74. http://j.bjfu.edu.cn/article/id/8990

    LIU J H, SHU Q. Virtual prototype of straw-checkerboard sand barriers paving robot and ride comfort[J]. Journal of Beijing Forestry University, 2007, 29(4):72-74. http://j.bjfu.edu.cn/article/id/8990
    [5] 李玉印, 潘海兵, 刘晋浩.草方格铺设机构的研究与设计[J].林业机械与木工设备, 2009, 37(5):13-15. doi:  10.3969/j.issn.2095-2953.2009.05.004

    LI Y Y, PAN H B, LIU J H. Study and design of the straw-checker paving mechanism[J]. Forestry Machinery & Woodworking Equipment, 2009, 37(5):13-15. doi:  10.3969/j.issn.2095-2953.2009.05.004
    [6] 潘海兵, 刘晋浩.防风固沙机器人振动系统的研究[J].中国工程机械学报, 2008, 6(4):379-383. doi:  10.3969/j.issn.1672-5581.2008.04.001

    PAN H B, LIU J H. Study on vibration system for check-straw-paving robots[J]. Chinese Journal of Construction Machinery, 2008, 6(4):379-383. doi:  10.3969/j.issn.1672-5581.2008.04.001
    [7] 孙术发, 刘晋浩, 叶郁.防风固沙草方格铺设机器人横向割断机构的动力学分析[J].中国沙漠, 2011, 31(5):1087-1092. http://d.old.wanfangdata.com.cn/Periodical/zgsm201105002

    SUN S F, LIU J H, YE Y. Dynamics analysis on transverse cutting mechanism of straw checkerboard paving robot[J]. Journal of Desert Research, 2011, 31(5):1087-1092. http://d.old.wanfangdata.com.cn/Periodical/zgsm201105002
    [8] 唐伟国, 刘晋浩, 李村, 等.多杆横向插刀机构的运动学研究及仿真[J].机械工程与自动化, 2017(2):38-39. doi:  10.3969/j.issn.1672-6413.2017.02.016

    TANG W G, LIU J H, LI C, et al.Kinematics research and simulation of multibar transverse inserted knife mechanism[J].Mechanical Engineering and Automation, 2017(2):38-39. doi:  10.3969/j.issn.1672-6413.2017.02.016
    [9] HU X P, ZUO F Y. Research and simulation of robot trajectory planning in joint space[J]. Applied Mechanics & Materials, 2012, 103:372-377. http://d.old.wanfangdata.com.cn/Conference/WFHYXW632476
    [10] BAWAB S, KINZEL G L, WALDRON K J. Rectified synthesis of six-bar mechanisms with well-defined transmission angles for four-position motion generation[J]. Journal of Mechanical Design, 1996, 9(118): 377-383. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=0a7d0282cb3c5e55c09dd4a831d8ed48
    [11] SHIAKOLAS P S, KOLADIYA D, KEBRLE J. On the optimum synthesis of six-bar linkages using differential evolution and the geometric centroid of precision positions technique[J]. Mechanism & Machine Theory, 2003, 40(3): 319-335. http://cn.bing.com/academic/profile?id=ff26183058b83b51cd64fb62291cab47&encoded=0&v=paper_preview&mkt=zh-cn
    [12] CHAI F J, XU J Y, XU Y. Kinematics simulation of steel tube rotating mechanism based on ADAMS[J]. Applied Mechanics & Materials, 2012, 130:2647-2650. http://www.scientific.net/AMM.130-134.2647
    [13] LI C H, YANG B J, CAI G Q. Optimization design of 3-TPT parallel robot based on ADAMS simulation technology[C]//International Workshop on Intelligent Systems and Applications. New York: IEEE, 2009: 1-4. https://ieeexplore.ieee.org/document/5072992/
    [14] 司凯.立体固沙车横向铺设系统的设计与研究[D].北京: 北京林业大学, 2011. http://cdmd.cnki.com.cn/Article/CDMD-10022-1011134583.htm

    SI K. Design and research on stereo sand-fixing car's transverse-paving system[D].Beijing: Beijing Forestry http://cdmd.cnki.com.cn/Article/CDMD-10022-1011134583.htm
  • [1] 袁硕, 李超, 陈昊, MuhammadAmir, 刘晓东.  福建省将乐县生物防火林带阻隔网空间布局与规划 . 北京林业大学学报, 2020, 42(): 88-95. doi: 10.12171/j.1000-1522.20190365
    [2] 董灵波, 蔺雪莹, 刘兆刚.  大兴安岭盘古林场森林碳汇木材复合经营规划 . 北京林业大学学报, 2020, 42(8): 1-11. doi: 10.12171/j.1000-1522.20190331
    [3] 闫佳伦, 董宇翔, 叶可陌, 索筠博, 闫娜, 韩莉, 林辰松.  基于鸟类栖息地营建的郊野公园规划设计研究 . 北京林业大学学报, 2019, 41(12): 153-166. doi: 10.12171/j.1000-1522.20190372
    [4] 任文子, 王新杰, AlexAppiah Mensah.  瑞典南部Ostad区私有林多目标森林经营中期规划 . 北京林业大学学报, 2019, 41(2): 97-105. doi: 10.13332/j.1000-1522.20180220
    [5] 李方正, 刘阳, 施瑶, 胡凯富, 郑曦.  基于生态系统服务功能模拟演算的绿色空间规划框架 . 北京林业大学学报, 2019, 41(11): 125-136. doi: 10.13332/j.1000-1522.20190149
    [6] 赵可, 刘晋浩, 黄青青, 孙浩, 王典.  林业并联式铰接底盘优化设计与越障性能仿真分析 . 北京林业大学学报, 2018, 40(10): 131-140. doi: 10.13332/j.1000-1522.20180179
    [7] 李滨, 单俊鑫.  聚脲喷枪混合室的设计和FLUENT仿真分析 . 北京林业大学学报, 2017, 39(3): 105-111. doi: 10.13332/j.1000-1522.20160254
    [8] 董灵波, 孙云霞, 刘兆刚.  基于碳和木材目标的森林空间经营规划研究 . 北京林业大学学报, 2017, 39(1): 52-61. doi: 10.13332/j.1000-1522.20160166
    [9] 韩东涛, 刘晋浩.  基于工作小臂的履带式林木采育机越障能力分析与研究 . 北京林业大学学报, 2016, 38(7): 105-111. doi: 10.13332/j.1000-1522.20150367
    [10] 朱阅, 阚江明.  三自由度铰接林用底盘的设计与越障性能分析 . 北京林业大学学报, 2016, 38(5): 126-132. doi: 10.13332/j.1000-1522.20150304
    [11] 李滨, 杨笑天, 王述洋.  基于FLUENT的森林防火小型无人机的机身仿真优化研究 . 北京林业大学学报, 2015, 37(11): 115-119. doi: 10.13332/j.1000-1522.20150132
    [12] 黄河山, 李婷, 刘晋浩.  6-HUS并联运动平台动力学建模与仿真分析 . 北京林业大学学报, 2015, 37(4): 143-150. doi: DOI:10.13332/j.1000-1522.20140349
    [13] 俞洋, 俞国胜, 德雪红, 袁大龙, 陈忠加.  基于ADAMS 的柱塞式环模成型装置的轨迹仿真研究 . 北京林业大学学报, 2014, 36(4): 147-151. doi: 10.13332/j.cnki.jbfu.2014.04.003
    [14] 沈嵘枫, 刘晋浩, 王典, 陈瑞洪.  联合采伐机工作臂运动轨迹及液压缸行程研究 . 北京林业大学学报, 2010, 32(2): 157-160.
    [15] 那晓东, 臧淑英, 张树清, .  基于遥感技术的大庆地区草地退化轨迹研究 . 北京林业大学学报, 2008, 30(增刊1): 108-115.
    [16] 张璧光, 白岗栓, 颜绍馗, 邓小文, 何亚平, 张莉俊, 刘杏娥, 胡胜华, 杨平, 李瑞, 张洪江, 秦爱光, 魏潇潇, 吴彩燕, 胡万良, 殷亚方, 王费新, 毛俊娟, 黄荣凤, 袁怀文, 王芳, 郑小贤, 周永学, 高黎, 赵天忠, 常旭, 崔赛华, 王晓欢, 刘燕, 张岩, 王胜华, 张克斌, 汪思龙, 王正, NagaoHirofumi, 王兆印, 李猛, 乔建平, 戴思兰, 王小青, 费世民, 罗晓芳, 樊军锋, 杜社妮, 孙向阳, 谭学仁, 王海燕, 范冰, KatoHideo, , 李昀, 陈放, 张旭, 张占雄, 刘云芳, 韩士杰, 李华, 龚月桦, 张双保, 高荣孚, 江玉林, 徐嘉, 孔祥文, 江泽慧, 陈秀明, 郭树花, 侯喜录, 任海青, , 陈宗伟, 丁磊, IdoHirofumi, 刘秀英, 常亮, 杨培华, 李晓峰, 李媛良, 高建社, 徐庆祥, , , 费本华, 陈学平, 李考学, 薛岩, 张桂兰, 蒋俊明, 张代贵, 金鑫, 王晓东, 续九如, 刘永红, 涂代伦, , 李雪峰, 丁国权, , 张红丽, , .  森林立木蓄积资源系统的计算机仿真实验研究 . 北京林业大学学报, 2007, 29(6): 104-108.
    [17] 马玲, 于海霞, 许景伟, 奚如春, 宋先亮, 吴家兵, 雷妮娅, 邵杰, 吕文华, 高克昌, 陆平, 周睿, 张志山, 郎璞玫, 李俊, 郑景明, 周艳萍, 刘足根, 武林, 李黎, 孙志蓉, 张春晓, 焦雯珺, 张建军, 于文吉, 金则新, 索安宁, 饶兴权, 赵广杰, 李传荣, 朱教君, 朱清科, 陈勇, 戴伟, 翟明普, 纳磊, 李钧敏, 毕华兴, 郑红娟, 赵秀海, 张小由, 陈少良, 于志明, 关德新, 蔡锡安, 葛剑平, 韦方强, Kwei-NamLaw, 习宝田, 马履一, 盖颖, 余养伦, 赵文喆, 张宇清, 李笑吟, 王天明, 方家强, 崔鹏, 张弥, 王瑞刚, 于波, 杨永福, 江泽慧, 曾小平, 谭会娟, 马履一, 夏良放, 李俊清, 樊敏, 朱艳燕, 李增鸿, 张春雨, 王文全, 袁小兰, ClaudeDaneault, 贾桂霞, 赵平, 郭孟霞, 李庆卫, 贺润平, 刘丽娟, 殷宁, 吴秀芹, 张欣荣, 何明珠, 李丽萍, 王贺新, 陈雪梅, 唐晓军, 王卫东, 袁飞, 邓宗付, 韩士杰, 毛志宏, 刘鑫, 王旭琴, 王娜, 熊颖, 王月海, 吴记贵, 孔俊杰, 蒋湘宁, 江杰, 于贵瑞, 郑敬刚, 王贵霞, 葛剑平, 李新荣, 林靓靓, 孙晓敏, 王瑞辉, 聂立水, 董治良, 郭超颖.  圆锯片横向变形与加工表面锯痕高度 . 北京林业大学学报, 2007, 29(1): 141-145.
    [18] 李雪华, 王兰珍, 李国雷, 李义良, 方升佐, 李生宇, 汪杭军1, 张冬梅, 赵铁珍, 薛康, 刘鹏举, 周传艳, 韦艳葵, 王立海, 王旭, 耿玉清, 任强, HUALi_zhong, 吴丽娟, 段文霞, 刘剑锋, 朱小龙, 党文杰, 雷加强, 宋永明, 崔同林, 韩士杰, 周亮, 余新晓, 李建章, 杨慧敏, 朱波, 苏晓华, 高岚, 黎明, 刘勇, JIANGXi_dian, 方陆明, 刘勇, 尹光彩, 李振基, 何茜, 阎秀峰, 周宇飞, 周国逸, 杨娅, 鹿振友, 喻理飞, 程云清, 宗文君, 徐新文, 王清文, 张冰玉, 唐小明, 周国逸, 沈熙环, 孙向阳, 王春林, 王新杰, 徐扬, 刘锐, 玲, 赖志华, 李吉跃, HEXiu_bin, 虞木奎, 柯水发, 李晓兰, 王伟宏, 茹广欣, 张志毅, 陈实, 郭蓓, 周晓梅, 孙阁, 温亚利, , 宋爱琴, 李俊清, 3, 齐涛, 国庆, 陈培金, 李丙文, 陈峻崎, 张可栋, 王旭, 蒋德明, 唐旭利, 王晓静, 王建林, 姚永刚, 长山, 刘志明, 周玉平, 赵双荣, 关少华, 宋湛谦, 陈放, 王春林, 杨伟伟, 闫俊华, 郑凌峰.  基于GIS的喀斯特森林生态仿真系统的构建 . 北京林业大学学报, 2007, 29(2): 152-155.
    [19] 谭健晖, 王戈, 尹增芳, 王蕾, 林娅, 李春义, 张运春, 李云开, 陈圆, 梁善庆, 张颖, 闫德千, 林勇明, 孙阁, 金莹杉, 周繇, 张仁军, 王春梅, 张玉兰, 王超, 李昌晓, 赵铁珍, 吴淑芳, 周海宾, 邢韶华, 崔丽娟, 张秀新, 刘杏娥, 任云卯, 张志强, 张曼胤, 樊汝汶, 徐秋芳, 钟章成, 高岚, 吴普特, 于俊林, 杨远芬, 马钦彦, 张明, 刘青林, 王莲英, 翟明普, 刘国经, 杨培岭, 江泽慧, 周荣伍, 黄华国, 赵勃, 张桥英, 王以红, 江泽慧, 洪滔, 马履一, 罗建举, 余养伦, 刘艳红, 温亚利, 崔国发, 陈学政, 周国逸, 王玉涛, 冯浩, 王希群, 张晓丽, 刘俊昌, 罗鹏, 田英杰, 吴承祯, 杨海军, 邵彬, 何春光, 周国模, 殷际松, 汪晓峰, 柯水发, 安玉涛, 张本刚, 于文吉, 王小青, 费本华, 骆有庆, 魏晓华, 徐克学, 蔡玲, 李敏, 赵景刚, 马润国, 康峰峰, 徐昕, 洪伟, 任树梅, 何松云, 邬奇峰, 刘爱青, 温亚利, 王九中, 高贤明, 费本华, 朱高浦, 赵焕勋, 胡喜生, 安树杰, 赵弟行, 吴宁, 田平, 林斌, 吴家森, 郑万建, 任海青, 宋萍, 李永祥, 卢俊峰, 范海兰.  景区生态容量微观仿真分析方法实证研究 . 北京林业大学学报, 2007, 29(3): 81-86.
    [20] 朱歆慧, 李文彬, 董金宝.  人体重心动摇轨迹的包络面积算法 . 北京林业大学学报, 2007, 29(4): 37-40.
  • 加载中
图(12)
计量
  • 文章访问数:  807
  • HTML全文浏览量:  117
  • PDF下载量:  12
  • 被引次数: 0
出版历程
  • 收稿日期:  2017-06-15
  • 修回日期:  2017-08-09
  • 刊出日期:  2017-10-01

步进式横向插刀机构的运动学求解与轨迹规划

doi: 10.13332/j.1000-1522.20170213
    基金项目:

    国家科技支撑计划项目 2015BAD07B00

    作者简介:

    隋婷婷,博士生。主要研究方向:森林工程及其自动化。Email:296654017@qq.com   地址:100083 北京市海淀区清华东路35号北京林业大学工学院

    通讯作者: 刘晋浩,教授,博士生导师。主要研究方向:林业与环境特种装备的研制与开发。Email:liujinhao@vip.163.com   地址:同上
  • 中图分类号: S776

摘要: 根据机构学原理,提出一种多杆步进式并联横向插草机构。通过Matlab软件求解运动学模型得到插刀机构标记点插草过程中连续变化的曲线, 利用fsolve函数进行插刀标记点的轨迹规划,借助Creo2.0对步进式插刀机构进行三维建模,并在ADAMS中对插刀机构作业时常设置的纵向宽900、1 000和1 100 mm这3种情况进行运动仿真,通过标记点P的运动轨迹分析步进式插刀机构的作业性能。结果表明:与旋转式插刀相比,步进式插刀机构具有良好的作业效率与精度,且操作灵活,能够满足铺设草方格的作业要求。

English Abstract

隋婷婷, 刘晋浩, 唐伟国. 步进式横向插刀机构的运动学求解与轨迹规划[J]. 北京林业大学学报, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
引用本文: 隋婷婷, 刘晋浩, 唐伟国. 步进式横向插刀机构的运动学求解与轨迹规划[J]. 北京林业大学学报, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
SUI Ting-ting, LIU Jin-hao, TANG Wei-guo. Kinematics solution and trajectory planning of stepping transverse slotting mechanism[J]. Journal of Beijing Forestry University, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
Citation: SUI Ting-ting, LIU Jin-hao, TANG Wei-guo. Kinematics solution and trajectory planning of stepping transverse slotting mechanism[J]. Journal of Beijing Forestry University, 2017, 39(10): 109-116. doi: 10.13332/j.1000-1522.20170213
  • 在机械固沙装备中,横向插刀机构是横向插草系统的重要组成部分,是固沙装备的重要执行机构。目前,固沙装备的研究人员对横向插刀做了大量的研究工作。基于国家高技术研究发展计划“863”项目研制了第一代防风固沙草方格铺设机器人,其采用气动垂直式插草方式[1],其中插刀的回位装置应用了圆柱螺旋弹簧。虽然研究人员对插刀进行了优化[2],但横向插刀入出土时,机器人在匀速前进,插刀会对沙土产生推动作用,用朗金(Rankine)被动土压力理论求解得出了沙土对插刀产生的最大推沙阻力,该阻力降低了插刀导杆的受力性能,使其容易弯曲变形[3]。而在横向机构高速插草时,还会将沙漠作业的震动感通过机器的振动系统传给人体和机器,产生损伤[4]。于是,第二代多功能立体固沙车中采用旋转式插刀,利用杆件的旋转与液压缸的伸缩,实现插刀的插入[5]。对于插刀的振动问题,运用第二类拉格朗日方程建立了振动力学模型和固沙装备的数学模型,有效分析其振动特性[6]。但草沙障铺设原材料的运动是间歇性瞬时停歇运动,要求机构具有迅速性和准时性的特点[7],而此结构中液压缸的运动是间歇的,伸缩控制具有迟滞性,插刀每次插入时机不够精准。

    横向插刀的相关研究表明:运行轨迹是影响插草效果的重要因素。插刀在水平方向的轨迹线越长,插刀在沙地以下的运动距离越长,容易出现犁沙现象,或者带着草沙障在沙土以下行走,铺设效果必然不佳。为解决该问题,提高固沙机器人的工作效率和操作精度,需要对插刀轨迹进行规划。杆件机构在实现复杂运动轨迹方面具有很大的优势,所以本研究提出了一种优化的多杆步进式并联横向插刀机构。而运动学模型的建立与分析不仅为动力学分析奠定了基础,也是机构设计的重要基础,因此对其进行运动学求解。并通过ADAMS多体动力学分析工具,分析其作业性能。

    • 横向插刀机构是多杆步进式并联横向插草系统的重要机构,该系统主要由多排链式横向输送草机构、多杆横向推草机构和多杆步进式并联插刀机构组成(图 1),插草系统以草捆为原材料,铺设不同深度、厚度和规格的横向草沙障。作业过程如下:草被多杆横向推草机构推落至沙地上,插刀机构与草接触后入沙,将草插入沙地,插刀随后出沙,形成草沙障。以此反复动作,从而达到作业效果。

      图  1  横向插草系统原理图

      Figure 1.  Transverse insert straw system

    • 横向插刀设计要符合整机作业标准。如图 2所示,假设AB为沙土平面,横向插刀工作时,从A点入沙,从B点出沙,将草插入沙土,形成横向草沙障。插刀进入沙地后的轨迹与地平面形成近似倒三角形的形状;插刀尖端点从入沙到出沙所形成的横向距离b在150~250 mm范围内越小越好;插刀插入沙地的深度h达到150 mm即满足要求[5]

      图  2  草沙障示意图

      Figure 2.  Sketch map of straw barrier

    • 根据设计标准,优化插刀机构的设计。如图 3所示,1、2为步进式插刀机构中并联布置的两套对称六杆机构,原理一致,为方便说明,取任意一套机构进行研究。

      图  3  多杆步进式并联插刀机构

      Figure 3.  Multi rod stepping type parallel slotting mechanism

      基于复数矢量法,文献[8]对六杆件单自由度插刀机构建立运动学模型。如图 4所示,包含OBCDOOBGFEO两个闭环,在实际应用中,杆件OB为原动件,从动件FGP为执行杆件,实现特定运动轨迹。可知各构件的角位移运动方程组为:

      $$ \left\{ \begin{array}{l} {L_2}{\rm{cos}}{\theta _2} - {L_3}{\rm{cos}}{\theta _3} = {L_0}{\rm{cos}}{\theta _0} - {L_1}{\rm{cos}}{\theta _1}\\ {L_2}{\rm{sin}}{\theta _2} - {L_3}{\rm{sin}}{\theta _3} = {L_0}{\rm{sin}}{\theta _0} - {L_1}{\rm{sin}}{\theta _1}\\ ({L_2} + {L_7}){\rm{cos}}{\theta _2} + {L_6}{\rm{cos}}{\theta _6} - {L_5}{\rm{cos}}{\theta _5} = - {L_1}{\rm{cos}}{\theta _1} + {L_4}{\rm{cos}}{\theta _4}\\ ({L_2} + {L_7}){\rm{sin}}{\theta _2} + {L_6}{\rm{sin}}{\theta _6} - {L_5}{\rm{sin}}{\theta _5} = - {L_1}{\rm{sin}}{\theta _1} + {L_4}{\rm{sin}}{\theta _4} \end{array} \right. $$

      各构件的角速度运动方程组为:

      $$ \left\{ \begin{array}{l} - {L_1}{{\dot \theta }_1}{\rm{cos}}{\theta _1} - {L_2}{{\dot \theta }_2}{\rm{cos}}{\theta _2} + {L_3}{{\dot \theta }_3}{\rm{cos}}{\theta _3} = 0\\ {\mathit{L}_1}{{\dot \theta }_1}{\rm{sin}}{\theta _1} + {L_2}{{\dot \theta }_2}{\rm{sin}}{\theta _2} - {L_3}{{\dot \theta }_3}{\rm{sin}}{\theta _3} = 0\\ {L_1}{{\dot \theta }_1}{\rm{cos}}{\theta _1} + ({L_2} + {L_7}){{\dot \theta }_2}{\rm{cos}}{\theta _2} - {L_4}{{\dot \theta }_4}{\rm{cos}}{\theta _4} - {L_5}{{\dot \theta }_5}{\rm{cos}}{\theta _5} + {L_6}{{\dot \theta }_6}{\rm{cos}}{\theta _6} = 0\\ - {L_1}{{\dot \theta }_1}{\rm{sin}}{\theta _1} - ({L_2} + {L_7}){{\dot \theta }_2}{\rm{sin}}{\theta _2} + {L_4}{{\dot \theta }_4}{\rm{sin}}{\theta _4} + {L_5}{{\dot \theta }_5}{\rm{sin}}{\theta _5} - {L_6}{{\dot \theta }_6}{\rm{sin}}{\theta _6} = 0 \end{array} \right. $$

      执行杆件上点P,即插刀顶端标注点的轨迹方程为:

      $$ \left\{ \begin{array}{l} P\left( x \right) = {L_4}{\rm{cos}}{\theta _4} + {L_5}{\rm{cos}}{\theta _5} - {L_6}{\rm{cos}}{\theta _6} + {L_8}{\rm{cos}}(\mathit{\delta } - {\theta _6})\\ P\left( y \right) = {L_4}{\rm{sin}}{\theta _4} + {L_5}{\rm{sin}}{\theta _5} - {L_6}{\rm{sin}}{\theta _6} - {L_8}{\rm{sin}}(\mathit{\delta } - {\theta _6}) \end{array} \right. $$

      根据实际作业工况,引入插刀机构随车体的行驶速度v(m/s)、插刀在水平方向上的位移x(mm)、插刀在竖直方向上的位移y(mm)、运动时间t(s)。建立多杆件横向插刀的合成轨迹方程:

      $$ \left\{ \begin{array}{l} x = {L_4}{\rm{cos}}{\theta _4} + {L_5}{\rm{cos}}{\theta _5} - {L_6}{\rm{cos}}{\theta _6} + {L_8}{\rm{cos}}(\delta - {\theta _6}) + \mathit{vt}\\ y = {L_4}{\rm{sin}}{\theta _4} + {L_5}{\rm{sin}}{\theta _5} - {L_6}{\rm{sin}}{\theta _6} - {L_8}{\rm{sin}}(\delta - {\theta _6}) \end{array} \right. $$

      图  4  多杆步进式并联插刀机构运动学模型

      Figure 4.  Kinematics model of multi rod stepping parallel slotting mechanism

    • 机构设计中,运动学分析是极为重要的环节之一,连杆机构的运动学方程是包含三角函数的非线性超越方程,求解复杂,因此选择具备强大数值计算功能的Matlab软件作为求解工具,该软件中fsolve函数的算法采用最小二乘法,便于求解非线性方程组的解,适用于多杆步进式横向插刀机构的运动学求解。

      首先设定各已知变量初始值:L0=309 mm,L1=130 mm,L2=297 mm,L3=162 mm,L4=302 mm,L5=250 mm,L6=493 mm,L7=262 mm,L8=946 mm,θ0=0,θ4=82°,δ=230°,根据角位移方程,在Matlab中求解得到结果(如图 5)。

      图  5  多杆步进式并联插刀机构角运动学求解

      Figure 5.  Kinematics solution of mechanism angle of multi rod stepping type parallel slotting mechanism

      分析可知:在一个运动周期内,θ2的变化范围为5°~58°,θ3为52°~160°,θ5为38°~130°,θ6为125°~165°。根据轨迹方程,得到插刀顶端标注点P的轨迹图(图 6)。

      图  6  插刀顶端标注点P运动轨迹

      Figure 6.  Motion path of point P marked on the top of slotting mechanism

    • 根据插刀机构的工作原理和插草过程,从草插入沙地到插刀离开沙土可分为2个阶段:合成插入运动和插刀出沙运动。

      插刀在沙土下的运动过程,即插刀从入沙到最终出沙的轨迹决定草沙障的最终插入深度。对初始设定值求解所得轨迹曲线近似为正三角,而非倒三角,说明插刀在沙粒以下运行的横向距离太大,即插刀带着草沙障在沙土中移动,不仅插不成草沙障,还会导致插刀在一次插草循环中,大部分时间是在巨大的沙土阻力下作业,因此杆件的初始值不能满足设计要求,需要对插刀的运动轨迹进行规划。

    • 多连杆机构运动轨迹复杂,初始设计值无法满足运动轨迹要求。轨迹规划包含着确定轨迹形状的过程,如果利用机械三维设计软件(SolidWorks、Pro/E等)来优化设计杆件长度、杆件夹角、造型模拟仿真,由于杆件长度组合多样,会导致需要造型的杆件模型数目巨大,不仅会增加设计任务,还会拖延工作进度。而利用Matlab编程软件来编制插刀的轨迹模拟程序,每次模拟求解只需改变变量的取值,为机构的轨迹规划提供了一种方便快捷的方法[9]

    • 改变杆长的取值,根据位移方程,分别求解出不同取值下对应的插刀顶端标注点P的轨迹[10]图 7为杆长L0L1L2L3L4L5L6L7L8参数改变时所对应的轨迹曲线变化情况,分析可知:杆长参数主要影响插刀顶端标注点P轨迹的取值范围;在一定取值范围内,L0L1L2L3L8对轨迹的影响多是在平移取值上,而L4L5L6L7除了使轨迹发生平移,还使其发生微弱的旋转变化;在影响幅度上,有强有弱。

      图  7  不同杆长取值下插刀顶端标注点P的运动轨迹变化

      Figure 7.  Motion path of point P marked on the top of slotting mechanism varies with rod length

    • 角度参数主要有θ0θ4δ

    • 定义θ4θ0=α,分两种情况进行分析[11]

      1)α=90°,θ0θ4变化。θ4分别取值90°、110°、130°、150°,轨迹曲线如图 8所示。随着θ0θ4取值的共同增大,标注点P的轨迹发生逆时针旋转式上升,轨迹曲线出现了“倒三角”的形状。

      图  8  插刀顶端标注点Pθ0θ4不同取值下的运动轨迹

      Figure 8.  8 Motion path of point P varies with θ0 and θ4

      2)α变化,分为θ0不变或θ4不变两种情况。仅列出θ0不变,θ4改变时轨迹的变化,另一种情况研究方法相同。保持θ0=0,θ4分别取值82°、87°、92°、97°、102°,轨迹变化如图 9所示。随着θ4取值的增大,曲线整体发生逆时针旋转的变化。

      图  9  插刀顶端标注点Pθ4不同取值下的运动轨迹

      Figure 9.  Motion path of point P varies with θ4

    • 图 10所示,在某一范围内,随着δ变小,插刀顶端在y轴方向上的位移在变大(即插刀的插入深度变大),轨迹整体呈现逆时针旋转的变化。

      图  10  插刀顶端标注点Pδ不同取值下的运动轨迹

      Figure 10.  10 Motion path of point P varies with δ

    • 求解结果显示:当L0=315 mm、L1=140 mm、L2=290 mm、L3=169 mm、L4=370 mm、L5=310 mm、L6=440 mm、L7=240 mm、L8=1 000 mm、θ0=60°、θ4=150°、δ=210°时,步进式横向插刀的运动轨迹与草沙障铺设需求最为贴近。在Matlab中设置草沙障纵向间距为900、1 000、1 100 mm,对应的设定的固沙装备行进速度分别为0.45、0.50、0.55 m/s进行仿真,插刀顶端标注点P运动轨迹分别如图 11所示。由于插刀机构独立于固沙装备单独运行,且固沙装备是匀速行驶,所以运行轨迹不变,仅在水平方向发生平移。

      图  11  Matlab仿真插刀顶端标注点P轨迹

      Figure 11.  Matlab simulation of motion path of the point P marked on the slotting tool

    • 为了清楚地比较步进式横向插刀与其他插刀的作业性能,在ADAMS软件中进行仿真分析[12-13],建立相同条件的插草要求,得到插刀机构的运动信息,从而大大简化了分析难度。

    • 虽然ADAMS-view的建模工具功能强大,但是相比Creo2.0建模工具的简易、实用,其建模过程复杂且不易。Creo2.0中提供装配模块,将装配后的虚拟样机导入ADAMS可以降低工作难度。

      基于设计要求,步进式插刀机构主要包括安装梁、马达传动装置、多杆机构和插刀刀体。完成插刀机构三维实体模型后,确定零件之间的位置约束关系,并装配成一个整体虚拟样机,检查各装配体之间是否有干涉以及运动情况是否合乎设计要求。若出现问题,可对生成的零件与特征进行修改定义,进一步提高物理样机加工制造的成功率。为了提高仿真效率,删除无关刚体,仅保留与插刀相关的关键刚体,用简化的长方体模型代替固沙装备车体,以便添加插刀的前进速度。将简化后的Creo2.0装配图文件另存后导入ADAMS。

    • 铺设纵向间距为900 mm宽的草沙障,设定固沙装备的行进速度为0.45 m/s,插刀马达的驱动速度为180°/s,仿真时间为4 s,仿真曲线如图 12a。数据显示,插刀最低端坐标(1 683,-607),A点坐标(1 638,-457),B点坐标(1 780,-457),故当插入深度为150 mm时,插刀入沙点和出沙点宽度142 mm。

      图  12  插刀顶端标注点P运动轨迹的ADAMS仿真

      Figure 12.  ADAMS simulation of motion path of the point P marked on the slotting tool

      铺设纵向间距为1 000 mm宽的草沙障,设定固沙装备的行进速度为0.50 m/s,插刀马达的驱动速度为180°/s,仿真时间为4 s,仿真曲线如图 12b。插刀最低端坐标(1 778,-607),A点坐标(1 724,-457),B点坐标(1 898,-457),故当插入深度为150 mm时,插刀入沙点和出沙点宽度174 mm。

      铺设纵向间距为1 100 mm宽的草沙障,设定固沙装备的行进速度为0.55 m/s,插刀马达的驱动速度为180°/s,仿真时间为4 s,仿真曲线如图 12c。插刀最低端坐标(1 883,-607),A点坐标(1 816,-457),B点坐标(2 020,-457),故当插入深度为150 mm时,插刀入沙点和出沙点宽度204 mm。

      仿真结果显示:ADAMS仿真曲线与Matlab仿真曲线相吻合,验证了运动学求解的正确性。在铺设纵向宽为900、1 000和1 100 mm的草沙障时,横向插刀的插入深度均为150 mm,插入点和离地点宽度分别为142、174和204 mm。由此看出,当设定纵向带为1 000 mm时,插刀插入点和离地点的宽度保持在170 mm左右。

    • 文献[14]对旋转式横向插刀进行了ADAMS仿真与作业试验。ADAMS仿真中,铺设纵向间距为1 000 mm宽的横向草沙障,设定固沙装备的行进速度为0.5 m/s时,得到插刀入沙出沙点距离为223 mm,草沙障插入深度为222 mm。多功能立体固沙车研制成功后,在内蒙古防风固沙示范基地进行作业试验。设置车身行驶速度为0.5 m/s,铺设纵向间距为1 000 mm的横向草沙障。试验数据显示:旋转式插刀的草沙障插入深度集中在165~240 mm之间,草沙障宽度在220~240 mm左右。分析可知,草沙障宽度与深度的实测曲线振幅较大,主要是由于作业过程中液压系统的伸缩控制具有不确定性,机构间的配合不能按照设计要求精准地控制插刀入沙出沙。

      本研究提出的多杆并联步进式横向插刀机构避免了多驱动配合的问题,插刀机构随车前进,旋转一周插草一次,按照设计轨迹进行铺设作业。ADAMS仿真结果显示,多杆并联步进式横向插刀机构铺设纵向距离为1 000 mm、深度为150 mm的草沙障时,草沙障宽度为174 mm,比旋转式插刀降低了约50 mm,提高了草沙障铺设的精准性和效率。

    • 根据机构学原理,提出了一种适用于草沙障铺设的多杆步进式并联横向插刀机构,进行了机构的设计与分析。利用Matlab软件求解运动学模型并进行轨迹规划,得到插刀轨迹曲线。应用Creo2.0软件建立了横向插刀机构模型,并在ADAMS环境下对插刀机构的3种工况进行了运动学仿真。仿真曲线与Matlab规划曲线相吻合,验证了其准确性。将步进式插刀仿真结果与旋转式插刀相关数据进行相比,结果表明:与旋转式插刀相比,步进式插刀机构具有良好的作业效率与精度。但依旧存在问题与不足,为使横向插刀机构在固沙装备上更好地应用,以下问题需要深入研究:首先,为了增强机构的强度和刚度,机构的质量往往被忽略,下一步应基于轻量化原则,在保证结构强度和刚度的前提下进行结构优化,尽可能地节约材料,提高作业效率;另外,本研究仅对多杆插刀机构进行了理论分析与仿真,并未进行动力学分析及功能性试验,接下来应研究其动力学系统并组装试验平台,验证该插刀机构的实际作业效果。

参考文献 (14)

目录

    /

    返回文章
    返回