机器人技术实验报告
- 格式:doc
- 大小:42.50 KB
- 文档页数:6
机器人技术基础实验报告班级:学号:姓名:台号:课程 1 机器人系统认识成绩:批改日期:教师签字:实验目的:1、使学生了解机器人系统的基本组成;2、增强学生的动手操作能力;3、熟悉机器人的基本操作。
实验设备及软件:1、珞石XB4机器人2、桌面示教应用程序实验原理:实验内容:1、 设备启动,启动EtherCAT 服务程序,启动机器人运动控制程序。
● 打开控制柜,确认急停开关D 和F 未被按下,如被按下顺时针转动,抬起急停开关。
顺时针旋转开关A ,随后将B 按至常亮,观察七段数码管是否显示数字8,若成功进入下一步。
●按压开关A,启动机器人控制器,开启后指示灯B 常亮,同时通讯服务程序自启动。
●启动机器人桌面控制程序“HBRobotConfigure”2、 标注六个关节正方向。
打开HBRobotConfigure 软件,先点击“重启控制程序”单击“连接”与控制器建立连接(机器人运动控制程序已启动)。
进入示教调试界面,单击“添加机器人模型”,并单击“运行”,显示实际或仿真机器人状态。
点击左侧“使能”和“下电”,控制机器人的使能状态。
选择轴坐标系,操作界面右侧加减按键观察机械臂各轴转向,确定各关节正方向。
ABCD操作流程:将机械臂各关节按①至⑥编号,如下图所示。
①俯视图中逆时针为正方向②左视图中顺时针为正方向③左视图中顺时针为正方向④正视图中顺时针为正方向⑤左视图中顺时针为正方向⑥俯视图中顺时针为正方向3、示教机器人,并保存工作空间中的三个点。
进入程序调试界面,调整移动速度至1%,将“Simulation”调至false进入真机模式,使能下电后通过界面按钮移动机械臂,移动明显距离后保存坐标点p1,重复操作3次以此获得工作空间中三点p1、p2、p3。
4、编写机器人脚本并运行机器人脚本,实现三个点之间的直线运动。
(先仿真运行,确认无误后再真机运行。
)1.先将左侧“Simulation”键调整为ture进入仿真模式。
机器人技术基础实验报告6一、实验目的本次机器人技术基础实验的目的在于深入了解机器人的运动控制、感知与交互能力,并通过实际操作和观察,掌握机器人系统的基本原理和应用方法。
二、实验设备1、机器人本体:采用了一款具有多关节自由度的工业机器人模型。
2、控制器:配备了高性能的运动控制卡和处理器,用于实现对机器人的精确控制。
3、传感器套件:包括视觉传感器、力传感器和距离传感器等,以获取机器人周围环境的信息。
4、编程软件:使用了专业的机器人编程工具,具备图形化编程和代码编辑功能。
三、实验原理1、运动学原理机器人的运动学研究了机器人各个关节的位置、速度和加速度之间的关系。
通过建立数学模型,可以计算出机器人末端执行器在空间中的位置和姿态。
2、动力学原理动力学分析了机器人在运动过程中所受到的力和力矩,以及这些力和力矩对机器人运动的影响。
这对于设计合理的控制策略和驱动系统至关重要。
3、传感器融合技术通过融合多种传感器的数据,如视觉、力和距离等信息,可以使机器人更全面、准确地感知周围环境,从而做出更智能的决策和动作。
四、实验步骤1、机器人系统初始化首先,对机器人进行了机械和电气连接的检查,确保各部件安装牢固且线路连接正常。
然后,通过控制器对机器人进行初始化设置,包括关节零位校准、运动范围设定等。
2、运动控制编程使用编程软件,编写了简单的运动控制程序,实现了机器人的直线运动、圆弧运动和关节空间的运动轨迹规划。
在编程过程中,充分考虑了运动速度、加速度和精度的要求。
3、传感器数据采集与处理启动传感器套件,采集机器人周围环境的信息。
通过编写相应的程序,对传感器数据进行滤波、融合和分析,提取有用的特征和信息。
4、机器人交互实验设计了人机交互场景,通过示教器或上位机软件向机器人发送指令,观察机器人的响应和动作。
同时,机器人也能够根据传感器反馈的信息,主动与环境进行交互,如避障、抓取物体等。
五、实验结果与分析1、运动控制精度通过对机器人运动轨迹的实际测量和与理论轨迹的对比分析,发现机器人在直线运动和圆弧运动中的位置精度能够达到预期要求,但在高速运动时存在一定的误差。
实验原理1.硬件部分Bioloid是一套科学教育用的机器人套件组,使用不同模块化的运动关节(机器人伺服马达),来建造各式各样的机器人,Bioloid Robot完整套件组,可以组合出18个关节(18 DOF自由度)的双足机器人、犬型机器人、恐龙、机器电铲、家用机器人、蜘蛛侠、蛇形机器人等。
机器人使用「AX-12(智能型伺服马达)」,具有位置控制与讯号回馈功能。
设计者可以手动制定出动作,让Motion Editor 记忆并且仿真,省去繁复的位置控制。
通过Behavior control来建构完整的机器人动作。
如此,便可通过Behavior Control Programer给机器人编排出一套完整的动作。
Bioloid可以从传感器以及关节读取多种信息,并利用这些信息实现全自动运动。
例如:可以制作一个机器狗,让它在听见一声拍手声时站起来,听到两声拍手声时坐下,或者制作一个机器人,当人靠近它时,它就鞠躬。
还可以做一个机器车,可以躲避障碍物或捡起物体,也可以通过遥装置控制机器人各种动作。
只要利用提供的动作编辑软件、行为编译软件,即使没有机器人知识背景的人也可以很容易的编辑机器人,实现机器人各种动作。
对于高级使用者可以用C语言编辑机器人各种运动算法,实现更加复杂的控制。
此外,机器人还配有手柄,可以通过设定,直接使用手柄控制机器人的行动,而不用依赖于数据线的指令传送。
这样就可以摆脱线控的束缚,灵活操控机器人,从而实现更多丰富的动作,既增强了可操作性,有增加了娱乐性。
2.软件部分能够对机器人进行编程的主要有五种软件,行为控制(RoboPlus Task)、动作编辑器(RoboPlus Motion)、机器人终端(RoboPlus Terminal)、机器人管理(RoboPlus Manager)和电机升级(Dynamixel Wizard)。
下面我们将主要介绍行为控制和动作编辑器。
①行为控制(RoboPlus Task)这款软件通过逻辑函数设计机器人在面对事件时的反应。
慧鱼机器人实验报告一、引言。
慧鱼机器人是一款基于人工智能技术的智能机器人,具有语音识别、图像识别、运动控制等功能。
本实验旨在测试慧鱼机器人在不同环境下的表现,以及对其进行性能评估。
二、实验目的。
1. 测试慧鱼机器人在不同光照条件下的图像识别能力;2. 评估慧鱼机器人在复杂环境中的语音识别准确度;3. 检验慧鱼机器人的运动控制能力和避障能力。
三、实验方法。
1. 图像识别测试,在不同光照条件下,使用慧鱼机器人进行物体识别测试,记录其识别准确率;2. 语音识别测试,在嘈杂环境中进行语音控制实验,评估慧鱼机器人的语音识别准确度;3. 运动控制和避障测试,在复杂环境中设置障碍物,测试慧鱼机器人的运动控制和避障能力。
四、实验结果。
1. 图像识别测试结果显示,在不同光照条件下,慧鱼机器人的图像识别准确率分别为95%、92%和90%,表现稳定且良好;2. 语音识别测试结果表明,在嘈杂环境下,慧鱼机器人的语音识别准确率达到了85%,满足一般应用需求;3. 运动控制和避障测试显示,慧鱼机器人能够稳健地避开障碍物,并且在复杂环境中表现出良好的运动控制能力。
五、实验分析。
慧鱼机器人在图像识别、语音识别和运动控制方面表现出了良好的性能。
然而,在实际应用中,仍需考虑到环境的复杂性对其性能的影响。
例如,光照条件的变化、嘈杂环境下的语音识别等都可能对慧鱼机器人的表现产生一定影响。
六、结论。
慧鱼机器人在实验中表现出了良好的图像识别、语音识别和运动控制能力,具有较高的应用潜力。
然而,其在复杂环境下的表现仍需进一步优化和改进。
未来,我们将继续对慧鱼机器人的性能进行评估,并不断改进其技术,以满足更广泛的应用需求。
七、致谢。
感谢所有参与本实验的工作人员和支持单位,在实验过程中给予的帮助和支持。
同时也感谢慧鱼机器人的开发团队,为我们提供了这样一款优秀的智能机器人。
工业机器人实验报告篇一:工业机器人实验报告工业机器人实验报告成绩批阅人实验名称:机器人认知实验实验地点指导教师小组成员实验日期班报告级人一、实验目的:二、实验设备及仪器三、六自由度工业机器人机构简图四、思考题1. 说明工业机器人的基本组成及各部分之间的关系。
第 1 页2. M-6iB机器人机械部分主要包括哪几部分?指出控制姿态与控制手腕动作的轴。
第 2 页工业机器人实验报告成绩批阅人实验名称:机器人编程实验实验地点指导教师小组成员实验日期班报告级人一、实验目的:二、实验设备及仪器三、实验步骤四、程序说明动作任务,记下动作程序,并在程序后面做适当的注解说明。
第 3 页五、思考题1.简述工业机器人在实际生产运用中采用示教控制与其它控制方式相比有什么优点?2.回忆本次实验过程,你从中学到了哪些知识。
第 4 页篇二:工业机器人实验报告本科生实验报告实验课程机器人技术基础学院名称核技术与自动化工程学院专业名称机械工程及自动化学生姓名学生学号指导教师实验地点JB201 实验成绩二〇 15 年 5 月二〇 15 年 5 月填写说明1、适用于本科生所有的实验报告(印制实验报告册除外);2、专业填写为专业全称,有专业方向的用小括号标明;3、格式要求:①用A4纸双面打印(封面双面打印)或在A4大小纸上用蓝黑色水笔书写。
②打印排版:正文用宋体小四号,1.5倍行距,页边距采取默认形式(上下2.54cm,左右2.54cm,页眉1.5cm,页脚1.75cm)。
字符间距为默认值(缩放100%,间距:标准);页码用小五号字底端居中。
③具体要求:题目(二号黑体居中);摘要(“摘要”二字用小二号黑体居中,隔行书写摘要的文字部分,小4号宋体);关键词(隔行顶格书写“关键词”三字,提炼3-5个关键词,用分号隔开,小4号黑体);正文部分采用三级标题;第1章××(小二号黑体居中,段前0.5行)1.1 ×××××小三号黑体×××××(段前、段后0.5行)参考文献(黑体小二号居中,段前0.5行),参考文献用五号宋体,参照《参考文献著录规则(GB/T 7714-XX)》。
机器人技术基础实验报告
1、实验目的
实验的目的是熟悉机器人技术的基础实验,包括机器人的结构特性、传动原理、机械构
件、机器人轨迹规划等方面的基础概念和知识。
2、实验内容
本实验结合相关书籍和课程,涵盖六个主要方面:
(1)机器人结构特性:包括机器人极其关节的结构特征,如关节的中心距、CAD模型的结构图、几何变换以及机器人控制体系等。
(2)传动原理:传动原理是机器人技术的核心,主要涉及传动机构的驱动原理和工作原理,包括动力学分析、轴向力和紧定力的计算、变速箱的类型及其拓扑、传动系统性能的评价以及机器人的控制技术。
(3)机械构件:机械构件是构建机器人的基础,主要包括机械构件的特性分析及应用,如凸轮轴、滚珠丝杆、电机及带轮等。
(4)机器人轨迹规划:机器人的轨迹规划是重点内容,主要涉及机器人轨迹的编程、运动学分析、示教编程、轨迹压缩、张量标定以及DSP
技术等。
(5)夹具设计:夹具设计是机器人应用中重要内容,主要涉及气压夹具结构设计及其应用,以及夹具装配技术、理论模型分析、夹紧结构动力学建模及物理实验室中用机器人进行夹具设计的实践应用。
(6)机器原理:机器原理涉及机器人控制体系的基本结构、编程思想、控制理论及应用技术,包括计算机硬件、软件架构、机器人控制技术和其他控制技术等。
3、实验结果
本实验的执行有序,基本实验项目全部完成,实验结果可按照预期得到一个有效的机器人模型,熟悉机器人技术的基础知识,具有较强的实践能力,能够应用机器人技术进行实际工程应用。
机器人实验报告一、实验背景随着科技的飞速发展,机器人在各个领域的应用越来越广泛。
为了深入了解机器人的性能和功能,我们进行了一系列的实验。
二、实验目的本次实验的主要目的是:1、测试机器人在不同环境下的运动能力和适应性。
2、评估机器人的感知系统,包括视觉、听觉和触觉等方面的表现。
3、探究机器人在执行任务时的准确性和效率。
三、实验设备与材料1、实验所用机器人型号为_____,具备多种传感器和执行器。
2、测试场地包括室内的平整地面、有障碍物的区域以及室外的不同地形。
3、相关的测试工具,如测量距离的仪器、记录数据的设备等。
四、实验过程(一)运动能力测试1、在室内平整地面上,设置了一定长度的直线跑道,让机器人以不同的速度进行直线运动,并记录其到达终点的时间和运动过程中的稳定性。
2、在有障碍物的区域,放置了各种形状和高度的障碍物,观察机器人如何避开障碍物并继续前进,同时记录其避障的反应时间和准确性。
(二)感知系统测试1、视觉感知测试:在不同的光照条件下,展示不同颜色和形状的物体,观察机器人能否准确识别并做出相应的反应。
2、听觉感知测试:在不同的声音环境中,发出特定的声音指令,检测机器人对声音的识别和响应能力。
3、触觉感知测试:让机器人接触不同质地和硬度的物体,检查其对触觉信息的感知和处理能力。
(三)任务执行测试1、设定了一系列的任务,如搬运物品、整理物品、搜索特定目标等,观察机器人完成任务的准确性和所需时间。
五、实验结果与分析(一)运动能力1、机器人在直线运动中,速度越快,稳定性略有下降,但总体表现良好,能够在规定时间内到达终点。
2、在避障测试中,机器人能够及时检测到障碍物,并采取合理的避障策略,但在面对复杂的障碍物组合时,偶尔会出现碰撞情况。
(二)感知系统1、视觉感知方面,机器人在正常光照条件下对颜色和形状的识别准确率较高,但在低光照环境中,识别能力有所下降。
2、听觉感知表现较为出色,能够准确识别各种声音指令,并迅速做出响应。
实验一、Matlab 验证斯坦福机械手雅可比矩阵 一、实验目的1.加深对雅可比矩阵的认识,熟练其计算原理;2.熟练掌握D-H 连杆坐标系的确定方法和过程及各种变换矩阵;3.熟悉Matlab 的操作与运用。
二、实验原理对机械手的操作和控制,除了需要确定机械手操作空间与关节空间之间静态位资的映射转换关系以外,还需要对某一时刻机械手运动速度和关节速度之间的关系进行转换和分析,也就是机械手瞬时速度分析。
而我们利用雅可比矩阵来对机械手的速度进行了分析。
其中雅可比矩阵包括了两个方面:1.雅可比矩阵平移速度部分的分析;2.雅可比矩阵旋转速度部分的分析。
T 矩阵由以下公式计算可得:1111111111s 0001iii i i i i i i i i ii i i i i i c a s c c c s s d T s s c s c c d θθθαθαααθαθααα-----------⎡⎤⎢⎥--⎢⎥=⎢⎥⎢⎥⎣⎦三、实验步骤1、已知计算各级T 矩阵665544445436546655221132210321220000000010001000000000100001000100011000000000100101000001001---⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥-⎢⎥⎢⎥⎢⎥===⎢⎥⎢⎥⎢⎥--⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦--⎡⎤⎡⎤⎢⎥⎢⎥--⎢⎥⎢⎥===⎢⎥⎢⎥-⎢⎥⎢⎥⎣⎦⎣⎦-c s c s c s s c T T T s c s c c s c s d d T T T s c 1100001001⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦s c 2、计算出各连杆坐标系到基坐标系0的变换矩阵:11110111212112112121121022221211213212121121321203222000000001010010000000100-⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥==⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦----⎡⎤⎡⎤⎢⎥⎢⎥-⎢⎥⎢⎥==⎢⎥⎢⎥-⎢⎥⎢⎥⎣⎦⎣⎦---+++=-可知可知c s s c T z c c c s s s d s s c s s c c d c T z s c c c s c s c d s s d s c c s s s d s c d T s c c d 12123320010⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦可知c s s s z c 1241412414121231212414124141212312042424223124141251241451251241412312124145050001()()()----⎡⎤⎢⎥+-++⎢⎥=⎢⎥-⎢⎥⎣⎦--------+-=++c c c s s c c s s c c s c s d s d s c c c s s c s c c s s s s d c d T s c s s c c d c c c s s c s s c c c s s s c s c c c s s c c s d s d s c c c s c s T 12512414512512414123122423124514512512312124514512512312062455223()2452524525000112345600⎡⎤⎢⎥-+--+--+++⎢⎥⎢⎥-⎢⎥⎣⎦-+-++++=-s s s c c c s s s s c s c s c c s s d c d s c c c s s c s c c s s c d X X c c c s s s s c s c c s d s d X X s c c s c s s s s c s s d c d T X X s c s c c c d 01⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦Matlab 计算过程如下:>> clear>> syms c1 s1 c2 s2 c3 s3 c4 s4 c5 s5 c6 s6 d1 d2 d3 d4 d5 d6 a1 a2 a3 a4 a5 a6>> T10=[c1 -s1 0 0;s1 c1 0 0;0 0 1 0;0 0 0 1]>> T21=[c2 -s2 0 0;0 0 1 d2;-s2 -c2 0 0;0 0 0 1] >> T32=[1 0 0 0;0 0 -1 -d3;0 1 0 0;0 0 0 1] >> T43=[c4 -s4 0 0;s4 c4 0 0;0 0 1 0;0 0 0 1] >> T54=[c5 -s5 0 0;0 0 1 0; -s5 -c5 0 0;0 0 0 1] >> T65=[c6 -s6 0 0;0 0 -1 0;s6 c6 0 0;0 0 0 1]>> T20=T10*T21; >> T30=T20*T32; >> T40=T30*T43; >> T50=T40*T54; >> T60=T50*T65;>> T60=simplify(T60)3、用速度矢量合成的方法计算雅可比矩阵Jv 部分:356124123456102040506016263465666124561020162631245600000⎡⎤=⎢⎥⎢⎥⎣⎦⎡⎤⨯⨯⨯⨯⨯=⎢⎥⎣⎦⎡⎤⨯⨯=⎢⎥⎣⎦v v v v v v J J J J J J J J J J J J J z p z p z z p z p z p z z z z z z p z p z z z z z z ωωωωωω 1) 计算1016⨯z p1z 为连杆1坐标系的z 轴单位向量在基坐标系0中的描述;16p 为连杆1坐标系原点到连杆6坐标系原点连线矢量16O O,在基坐标系0中的描述,计算过程为:计算矩阵T61,T61的第四列即为16O O,由于坐标系1相对于坐标系0有绕Z 轴的转动,故需要对其进行转换,转换方法为;0116O O ⋅ R ,01R为T10中旋转部分注:Matlab 中向量叉积方法:e=cross (a,b)>> T61=T21*T32*T43*T54*T65 %计算出16O O在坐标系1中的描述>> P161=[s2*d3;d2;c2*d3]>> Rot10=[c1 -s1 0;s1 c1 0;0 0 1] %由T10知道旋转部分变换3*3矩阵 >> P160= Rot10* P161 % 与P60最后一列比较 >> z1=[0;0;1]>> e=cross(z1,P160) %可得到Jv 第一列: e =[ -s1*s2*d3-c1*d2; c1*s2*d3-s1*d2;0]2) 计算2026⨯z p2z 为连杆2坐标系的z 轴单位向量在基坐标系0中的描述;206p 为连杆2坐标系原点到连杆6坐标系原点连线矢量26O O,在基坐标系0中的描述,计算过程为:计算矩阵P62,P62的第四列即为26O O,由于坐标系2相对于坐标系0有姿态变化,故需要对其进行转换,转换方法为;0226O O ⋅ R ,02R为T20中旋转部分注:Matlab 中向量叉积方法:e=cross (a,b)>> T62= T32*T43*T54*T65 %计算出26O O在坐标系2中的描述>> P262=[0;-d3;0]>> Rot20=[c1*c2 -c1*s2 -s1;s1*c2 -s1*s2 c1;-s2 -c2 0] %由T20知旋转部分变换3*3矩阵>> P260= Rot20* P262 >> z2=[-s1;c1;0]>> e=cross(z2, P260) %可得到Jv 第一列:e =[c1*c2*d3; s1*c2*d3; -s1^2*s2*d3-c1^2*s2*d3]3) 由于连杆3坐标系为移动坐标系,故起对连杆6的速度贡献不能计算为3036⨯z p ,而应该为Z3的单位向量在基坐标系0中的表示;故由T30直接可得Jv 第三列为:1212320⎡⎤⎢⎥⎢⎥=⎢⎥⎢⎥⎣⎦c s s s z c4)由于坐标系4、5、6和坐标系6的坐标原点重合故对应6066)=⨯=⨯ i i ()q(q i i O i i i v z O O z p 的计算结果均为0 ,于是可得 35612412345612123123121212312312232112414124141245145125112414124141245000000000000⎡⎤=⎢⎥⎢⎥⎣⎦---+-=------+-+-++v v v v v v J J J J J J J J J J J J J c d s s d c c d c s s d c s d s c d s s s d c s c c s s c c c s s c c c c s s s s c s c c s c s c c s c s c c s c c s c ωωωωωω14512524242455210⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥+⎢⎥-+⎢⎥⎣⎦s s s s c s s s s s c s c c 5) 用直接求导的方法验证上面Jv 的计算的正确性:在matlab 中用B=jacobian(f,v)方法直接求导可以获取雅可比矩阵四、实验总结机器人雅可比矩阵能够很好地反映出操作空间与关节空间的速度映射关系,而Matlab 则很好的简化了这种关系求导手段。
机器人基础原理实验报告班级:学号:姓名:台号: 2课程:4、机器人正运动学日期:成绩:教师签字:实验目的:1、学习连杆变换2、学习建立机器人的正运动学方程实验设备及软件:1、珞石XB4机器人2、MA TLAB实验原理:对一个具有n个自由度的操作臂,它的所有连杆位置可由一组n个关节变量来确定。
这样的一组变量常称为n*1的关节向量。
所有关节矢量组成的空间称为关节空间。
操作臂在空间中位置与姿态是在空间相正交的轴上进行描述的,一般称这个空间位笛卡尔空间,或任务空间和操作空间。
操作臂的位置与姿态可以在关节空间或笛卡尔空间进行描述。
正运动学是利用机器人各个关节变量的信息求取机器人末端的位置与姿态。
即实现关节空间到笛卡尔空间的变换。
根据连杆坐标系的建立步骤(改进D-H参数法),可知连杆坐标系{i}在坐标系{i-1}中描述为:该变换矩阵用于将在坐标系{i}中定义的矢量变换成坐标系{i-1}下的描述:对于n自由度机器人,分别计算出各个连杆变换矩阵,把所有连杆变换矩阵连乘就能得到一个坐标系{n}相对于坐标系{0}的变换矩阵:该变换矩阵n0T是关于n个关节变量的函数。
机器人末端连杆在笛卡尔坐标系下的位置和姿态能过通过n0T计算出来。
该表达式即为机器人的运动学方程。
带入D-H参数,即可求得相应的动力学方程的符号表达形式。
实验步骤:1、根据标准D-H参数法推导连杆坐标系{i}相对于坐标系{ i−1}的变换矩阵。
连杆坐标系{i}在坐标系{ i−1}中的描述为:3、根据各个连杆的变换矩阵表达式推导正运动学表达式。
操作臂末端执行器在机器人笛卡尔空间的位置描述:P B=T0B T60T T6P T其中: P T为末端执行器在坐标系{T}下的描述取为[1001000000001001];4、编写正运动学代码○1使用MATLAB软件打开\东大机器人实验程序\4、机器人正运动学\sia004.slx 文件。
○2、双击DH模块。
在该函数下,补充函数。