简介这份《慧鱼四自由度机械手说明书》是一份面向机械设计制造及其自动化专业学生、课程设计参与者及自动化教学人员的综合实践资料聚焦机械模型远程控制这一典型课题。资源以1个PDF文件承载压缩包约1.51MB内容完整涵盖课程设计说明书的主体结构。正文从机构模型原理图与工作原理切入逐一拆解前后运动、左右转动、上下运动、手爪顺逆时针转动及开闭合五个自由度的传动路径说明电机、减速箱、蜗杆蜗轮、齿轮链条与限位开关的配合关系。在此基础上资料进一步讲解远程控制系统的工作机制涉及主控端与被控端的数据交互、慧鱼接口板主动与被动两种处理模式的选择以及计算机与接口板之间的通讯协议实现。客户端程序部分则围绕VB编程展开介绍mscomm、winsock与timer三种控件的用法及程序调试思路并附结论心得与参考文献。目前已有231人学习适合需要参照案例完成装配、编程与远程控制联调的读者系统查阅。1. 慧鱼四自由度机械手说明书不是装配图册它其实是一份运动学参数表多数人拿到慧鱼四自由度机械手说明书翻两页就开始拧螺丝装完通电发现底座转一圈末端画的不是点而是一个圈夹爪永远差那么几毫米够不到料位。问题往往不在装配手法而在于说明书被当成图册用了。它同时是装配顺序表、零件清单、接线对照表以及一份藏起来的运动学参数表——连杆中心距、各关节的机械行程、电机编号与关节的对应关系全都散落在总装图标注和零件表里没人替你整理。这篇按一条工程路径往下推先读懂传动链和装配约束再在 TXT 控制器上跑通四个关节的点动然后补上正逆运动学最后用旋转中心标定和重复定位测试把精度收住顺带把节拍压下来。适合刚拆箱的人照着复现也适合已经能把它动起来、但做不到稳定取放的人对照排查。2. 慧鱼四自由度机械手的传动链拆解说明书总装图该怎么读2.1 四个自由度分别落在哪个电机上慧鱼出过多个机械手套件版本四自由度的常见分解是底座回转、大臂俯仰、小臂俯仰加上末端夹爪开合也有版本把第四个自由度做成腕部自转夹爪由第五个电机单独驱动。别先背结论打开总装图把每个电机符号旁边的编号抄成一张映射表这张表后面写程序、做标定、查故障都要反复用。映射表的第二列要写清楚这个电机接在控制器的哪个输出口。慧鱼控制器面板上的 M1 到 M4 是物理输出口软件里用的电机编号是逻辑编号两者默认一致但可以改。装配阶段把线插错口调试阶段就会看到写的是让大臂抬结果夹爪在动这种诡异现象然后开始怀疑程序浪费一晚上。自由度运动形式常见执行器说明书里的位置备注1底座回转带编码器直流电机总装图底座模块决定工作空间角度范围2大臂俯仰带编码器直流电机总装图立柱侧负载最大减速比最大3小臂俯仰带编码器直流电机总装图悬臂段与 2 构成平面两连杆4夹爪开合 / 腕转普通电机或编码器电机总装图末端决定能不能测重复精度提示前三个自由度用带编码器的电机第四轴如果只做开合用普通电机加限位检测就够如果要做腕部角度控制同样得换成编码器电机否则角度不可复现。2.2 零件表与传动比从齿条、蜗轮到夹爪说明书的零件表只给零件号和数量不给传动比。传动比得自己数齿轮副数主动轮与从动轮齿数齿条看齿距和驱动轮齿数蜗轮蜗杆数蜗杆头数和蜗轮齿数。这个数字直接决定脉冲当量也就是编码器每来一个计数关节实际转了多少度。没有它逆运动学算出来的角度没法翻译成电机指令。下面这段计算演示了从齿数推脉冲当量的过程注意编码器每转脉冲数这一项不同型号差别很大必须实测而不是照抄。import math # 以某个俯仰关节为例参数按实物数出来 / 实测出来再填 z_driver 20 # 主动齿轮齿数 z_driven 60 # 从动齿轮齿数 encoder_ppr 0 # 编码器每转脉冲数先用 0 占位用 2.3 节的反推法确定 gear_ratio z_driven / z_driver # 减速比 pulses_per_out_rev encoder_ppr * gear_ratio pulses_per_deg pulses_per_out_rev / 360 # 关节每转 1 度对应的脉冲数 def deg_to_pulse(deg): 把目标角度换算成需要发出的编码器计数 return int(round(deg * pulses_per_deg)) print(gear_ratio, deg_to_pulse(30))逻辑很直白先算减速比再算输出轴转一整圈需要多少脉冲最后平摊到每度。参数里最容易错的是encoder_ppr它不是你数出来的齿数而是电机尾端码盘每转产生的计数边沿数有的控制器做四倍频有的不做。正确做法是让关节空载慢速转 360 度读回计数差值除以 360得到的就是真实的pulses_per_deg再反推encoder_ppr。这一步不做后面所有角度都是估的。2.3 装配顺序与机构约束说明书页码顺序不能跳说明书的页码顺序不是排版随意而是装配可达性的约束。典型的两条回转盘必须先固定到底座再装大臂否则底座内部那几颗紧固件的操作空间会被大臂占掉同步带或齿条的张紧要在大臂、小臂都装到位之前调好反过来调就得拆半根臂。遇到说明书某一步画着从这里伸手进去拧那就是约束别自作聪明换顺序。另一类约束是机械限位。慧鱼套件会在关节行程两端留限位块或者靠结构件本身挡住这是硬限位撞上去电机堵转电流上升、齿轮受力。软件限位要设得比硬限位保守我一般取实测机械行程两端各留 3 到 5 度余量把这段留白当作安全区。走线也要在这一步处理好跨回转关节的线束留出一整圈的余量紧固在线槽里否则回转几十次之后线被绞断表现出来是某个关节偶尔抽一下。3. 在 TXT 控制器上跑通慧鱼四自由度机械手的最小程序3.1 接口确认TXT 的 M1–M4、编码器输入与供电动手写代码前先做三件事顺序别换。第一确认四个电机对应的输出口用控制器自带的测试功能逐个点动眼睛看着是哪个关节在动。第二确认编码器计数方向手动慢速正转关节看计数是加还是减方向反了要么在软件里取负要么把电机线对调两种都行但必须统一别一个关节一种。第三确认供电电池组满电和快耗尽时电机的实际转速差得不少后面做节拍计算和重复精度测试最好插稳压电源。端口类型接什么检查方法常见坑M1–M4四个关节电机逐个点动观察对应关节物理口与逻辑编号不匹配计数输入编码器信号线手动转关节看计数变化方向不一致导致角度反号电源电池组或适配器满电与低压各跑一次对比低压下节拍和精度同时变差3.2 用 Python 驱动四个关节做点动图形化编程上手快但要做运动学和标定用 Python 更省事。下面是点动骨架作用是给每个关节单独发一段固定功率、固定时长的动作并打印编码器计数这批数据就是标定的原材料。import ftrobopy # 连接 TXT 控制器的常用库 import time txt ftrobopy.ftrobopy(auto) # 自动搜索控制器 M [txt.motor(i) for i in range(1, 5)] # M1~M4 逻辑电机对象 def read_counter(idx): 读关节 idx 的编码器计数。 不同库版本方法名不一样先 dir(M[idx]) 看有哪些可用方法再替换。 return M[idx].getCurrentValue() def jog(idx, power, seconds): 点动关节 idx 以 power 功率运行 seconds 秒后停止。 power 取 0~512负值反转试机阶段建议不超过 200。 M[idx].setSpeed(power) time.sleep(seconds) M[idx].stop() time.sleep(0.3) # 等机械停稳再读数 print(joint, idx, counter, read_counter(idx)) for k in range(4): jog(k, 150, 0.8) # 慢速正转 jog(k, -150, 0.8) # 反向回位这段代码里有三个参数值得单独说。power是功率不是速度负值代表反方向首次试机一定用低值慧鱼的结构件和齿轮在堵转时很容易崩齿。seconds是开环时间只适合点动找范围正式点位控制应该改成走够多少计数就停的闭环写法。time.sleep(0.3)这段等待不能省电机停指令发出后机构还有惯性立刻读数会把过冲量算进计数里标定结果偏大。3.3 正运动学把说明书里的连杆长度填进公式关节角度换算到末端坐标靠的是连杆参数。打开说明书总装图量三个尺寸底座回转轴到肩关节的高度H0、大臂两关节中心距L1、小臂两关节中心距L2。这三个数字填进去正运动学就是一串三角函数不需要任何高深工具。import math L1, L2, H0 120.0, 100.0, 45.0 # 单位 mm按实测填写不要照抄 def forward(t1, t2, t3): t1 底座回转角、t2 大臂角、t3 小臂角单位度零位取水平方向 返回末端在基坐标系下的 (x, y, z)单位 mm a1, a2, a3 map(math.radians, (t1, t2, t3)) r L1 * math.cos(a2) L2 * math.cos(a2 a3) # 水平面内的投影半径 x r * math.cos(a1) y r * math.sin(a1) z H0 L1 * math.sin(a2) L2 * math.sin(a2 a3) return round(x, 2), round(y, 2), round(z, 2) print(forward(0, 45, -30))角度约定必须在代码注释里写死t2 0表示大臂水平t3 0表示小臂与大臂共线。约定一改说明书上的装配零位和代码就对不上越调越乱。H0容易漏很多人只算L1、L2结果算出来的 z 整体偏低一个底座高度末端总是砸在台面上。3.4 逆运动学求关节角给一个末端坐标就能算有了正解反解就是给定(x, y, z)求三个角。前三轴构成的其实是底座回转 平面两连杆可以拆开解底座角由水平方位直接定剩下的两连杆用余弦定理。这段代码是整套东西里最值得反复用的部分。def inverse(x, y, z, elbow_upTrue): 输入末端目标点返回 (t1, t2, t3)单位度。 elbow_up 控制肘部朝上还是朝下同一目标点有两组解。 t1 math.atan2(y, x) r math.hypot(x, y) # 目标点在水平面的投影半径 zz z - H0 c3 (r * r zz * zz - L1 * L1 - L2 * L2) / (2 * L1 * L2) if c3 -1.0 or c3 1.0: raise ValueError(目标点超出工作空间检查 r%.1f zz%.1f % (r, zz)) a3 math.acos(max(-1.0, min(1.0, c3))) * (1 if elbow_up else -1) a2 math.atan2(zz, r) - math.atan2(L2 * math.sin(a3), L1 L2 * math.cos(a3)) return round(math.degrees(t1), 3), round(math.degrees(a2), 3), round(math.degrees(a3), 3) print(inverse(150, 60, 200))c3越界的那次判断千万别省。目标点够不到时acos会直接抛数学域错误堆栈信息看不出是哪个点出的问题加上一句带数值的报错现场排查能省十分钟。elbow_up是同一个目标点的两组解选哪一组要看会不会撞台面、会不会碰到料架实际用的时候一般拿这两组解各跑一次正解验证再按避障挑一个。3.5 必须固定的几个参数参数含义怎么拿到典型坑脉冲当量每度对应多少计数空载转 360 度读计数差照抄型号参数忽略倍频关节零位各轴的 0 度位置慢速碰硬限位后退回余量每次上电零位不一致软件限位允许的角度范围机械行程两端各留 3–5 度等于硬限位长期堵转末端偏置夹爪中心相对腕关节的偏移用 4 章的旋转中心标定反推直接当成 0末端系统性偏这四项里最容易被忽略的是末端偏置。夹爪夹持点跟小臂末端关节中心通常不在一条线上偏几毫米做密集摆料时就是第一盘准、第二盘压。把它当作工具坐标写进逆解末端点先减去这个偏置再算角度问题立刻消失。4. 机械手旋转中心标定让慧鱼四自由度机械手对得准4.1 旋转中心偏了会怎样底座回转关节的理论轴线跟末端实际划出的那个圆的圆心往往不重合。原因很朴素装配同轴度、齿条间隙、末端偏置任何一项有几毫米误差底座转一圈末端就是一个半径几毫米的圆。表现出来就是末端永远对不住同一个点每次回转都偏一点摆料越密越明显。工业机械手上这一套叫工具坐标与旋转中心标定慧鱼这套没有自动标定流程得自己量。判断要不要标定有个土办法夹爪夹一支笔t2、t3保持不变只让底座分别停在 0、90、180、270 度看纸上四个点。四个点重合说明同轴度可以接受连起来是个圆圆心到四点的距离就是偏差量超过 2 毫米就该标了。4.2 四点法标定底座回转中心标定过程分三步。先把笔装进夹爪调t2、t3让笔尖轻轻落在贴了坐标纸的台面上记下这一组t2、t3作为标定姿态全程不动。第二步让底座分别停在四个角度每个角度都重复下降接触、抬升两次取接触点减少回程间隙带来的抖动用坐标纸读数或者俯拍图像量出坐标。第三步做圆的拟合圆心就是把末端坐标搬到回转中心上需要的补偿量。import numpy as np def fit_circle(xs, ys): 最小二乘拟合圆Kasa 法 返回圆心 (cx, cy) 与半径 r单位与输入一致 A np.c_[2 * np.array(xs), 2 * np.array(ys), np.ones(len(xs))] b np.array([x * x y * y for x, y in zip(xs, ys)]) cx, cy, c np.linalg.lstsq(A, b, rcondNone)[0] r math.sqrt(c cx * cx cy * cy) return round(cx, 3), round(cy, 3), round(r, 3) pts [(0.0, 0.0), (41.8, 2.1), (2.4, -40.6), (-39.9, 1.2)] # 四个角度下的实测落点 cx, cy, r fit_circle([p[0] for p in pts], [p[1] for p in pts]) print(回转中心补偿, cx, cy, 末端偏置半径, r)fit_circle的输入是同一姿态下末端在不同底座角度时的落点坐标输出(cx, cy)是拟合出的圆心相对坐标纸原点的位置r是末端到回转中心的距离。补偿方式是所有示教得到的末端目标点在送进逆运动学之前先加上(cx, cy)。r则用来核对L1、L2是否有测量误差如果r比你手量的投影半径差出 5 毫米以上回去重新量连杆中心距。四个点里有一个明显偏离不要迁就它去拟合那多半是某次接触没压实重点一次。4.3 重复定位精度怎么测20 次循环的数据判读标定完了要看结果方法是让机械手走到同一个目标点 20 次每次都从不同方向接近记录每次的实际落点算两个方向的极差和标准差。指标含义慧鱼结构的合理预期X 向极差20 次落点横坐标最大值减最小值与齿隙、夹爪重复夹持力有关Y 向极差同上纵坐标底座回转间隙的主要体现标准差离散程度比极差更抗偶发跳点单轴超过极差一半要查机械单向逼近误差正转到位与反转到位之差齿隙的直接读数def report(samples): samples 为 20 组 (x, y)单位 mm xs [s[0] for s in samples]; ys [s[1] for s in samples] print(X range %.2f Y range %.2f % (max(xs) - min(xs), max(ys) - min(ys))) print(X std %.3f Y std %.3f % (np.std(xs), np.std(ys)))单向逼近误差这一项最容易被忽略但它才是现场到点偏的根因。测法是同一个点分两种方式到位一直正转接近和一直反转接近两组数据分别求均值再做差。差值大说明齿隙大解决办法是让程序里所有点位都从同一个方向逼近比如永远先越过目标点 2 度再回来用这种方式绕开齿隙比拆机重调快得多。5. 慧鱼四自由度机械手的节拍优化与故障排查清单5.1 节拍拆解把一次取放拆成可压缩的 5 段时间节拍优化不是把速度调到最大而是先拆。一次完整取放拆成五段空程接近料位、末端下压、夹爪闭合、抬升并转移到放料位、返回原位。真正能压缩的是第一段和第四段因为它们是长距离空行程下压段和夹爪段受刚性限制硬提速度只会抖。常见的省节拍手法是把第四段的抬升和第一段的回转做成同时动作两个关节并行省掉一次停顿。可压缩项做法代价空程加速段提高加速度而非最高速结构抖动落点精度下降关节并行回转与抬升同时启动需要检查轨迹是否扫到料架夹爪等待夹紧后立即抬升不等完全静止夹持力不足时会掉件往返方向统一单向逼近省掉回程补偿单次节拍略增精度换稳定5.2 梯形速度曲线参数怎么给每个关节的位移都按梯形曲线规划先加速、再匀速、最后减速。给定位移、最高速度和加速度就能算出这段耗时用来判断到底该调哪个参数。def trape_time(s, vmax, acc): 位移 s(mm)、最高速度 vmax(mm/s)、加速度 acc(mm/s^2) 返回梯形或三角形速度曲线的总耗时秒 t_acc vmax / acc # 加速段时长 s_acc 0.5 * acc * t_acc ** 2 # 加速段走过的位移 if 2 * s_acc s: # 距离太短还没到最高速就得减速 return 2 * math.sqrt(2 * s / acc) return 2 * t_acc (s - 2 * s_acc) / vmax print(trape_time(200, 150, 300))输出的是理论最短耗时。vmax受结构共振限制慧鱼的铝型材和塑料件在高速下抖得厉害实测时逐步提高直到落点极差开始变大退回上一档就是这台的可用上限。acc受电机扭矩和齿轮强度限制加速度给大了表现是丢步编码器计数和实际位置对不上这一点在带编码器的轴上很容易验证跑完读计数和理论值差得多就是丢步了。5.3 故障对照表电机不转、夹爪打滑、计数漂移现象可能原因检查动作电机有声响但不转卡在硬限位或齿轮卡齿断电手动转该关节感受阻力点突然某个关节反向编码器线接反或软件符号错比对计数方向表统一取负夹爪夹不住夹持面磨损或夹紧行程不够贴一层薄胶皮或增大夹紧时间计数缓慢漂移线束在回转关节处受拉扯检查线束余量重走线槽回转时末端划圈旋转中心未标定回到 4.2 节做四点法5.4 借工业机械手的调试步骤做终检工业机械手比如 Epson 那类 SCARA 或六轴的调试步骤里上电第一步永远是原点复归确认各轴零位之后才允许跑点位。慧鱼这套没有自动回零就得自己补一个上电后各轴以低功率慢速朝机械限位方向走碰到限位电流上升或计数不再变化立即停退回设定余量把这个位置的计数写进零位偏移。顺序不能反先回零再跑程序不然第一句指令就是撞。手持控制器上的复位键也是同一个逻辑。示教器出现急停或报警时复位键的作用是先清报警状态、再让各轴具备上电使能的条件而不是代替回零。两者的处理顺序经常被搞混报警没清就急着跑点位或者清完报警直接从当前位置继续结果都是撞。要判断零位有没有长期漂移有个成本极低的办法每次上电复归结束后把四个轴的零位计数连同时间戳写进一个日志文件跑上一个月再看。哪一轴的计数开始单调偏移就是那条轴的紧固件松了或者线束受力趁还没撞件先处理。这行日志比任何事后排查都省事import time, json def log_home(counters, pathhome_log.jsonl): counters [c0, c1, c2, c3]每次上电复归后调用一次 rec {ts: time.strftime(%Y-%m-%d %H:%M:%S), home: list(counters)} with open(path, a, encodingutf-8) as f: f.write(json.dumps(rec) \n)本文还有配套的精品资源点击获取