双轴机械臂调试：步进电机42HS348E,BH32角度传感器，MCU:STC8H1K28
■ 前言
这款双轴机械臂是应用于实验室中进行自动样品转换的执行机构。为了能够在一定范围内将试剂瓶（试管） 完成自动搬运，需要完成对样品的抓取，提升和放下、水平移动（二维） 等功能。使用带有肘关节、肩关节以及上下移动关节的机械平台可以完成这项设计。
在基于STC8H1K28双轴机械臂驱动模块 给出了对肩关节、肘关节上的步进电机、角度传感器读取和控制模块的设计。本文下面就是利用该模块对机械臂进行运动控制。
▲ 双轴机械臂的外观
01联线配线
1.步进电机和角度传感器接口
(1) 步进电机引线
引出4PIN的接口，分别定义为：
| PIN | 符号 | 功能 | 颜色 |
|---|---|---|---|
| PIN1（MARK） | PU+,DR+,MF+ | 三个控制端口的公共电源线 | 红，蓝，棕 |
| PIN2 | PU- | 脉冲输入 | 黄 |
| PIN3 | DIR- | 方向输入 | 黑 |
| PIN4 | MF- | 势能输入 | 绿 |
上述定义的四线插头可以接入基于STC8H1K28双轴机械臂驱动模块中的PANGx(角度传感器端口)。
(2) BH38角度传感器接口
引出4PIN接口，定义为：
| PIN | 符号 | 功能 | 颜色 |
|---|---|---|---|
| PIN1(MARK) | +5V | 工作电源 | 棕：BROWN |
| PIN2 | 0V | 电源地 | 蓝：BLUE |
| PIN3 | A+ | 485总线A+ | 黑：BLACK |
| PIN4 | B- | 485总线B- | 白 |
另外两个引线置零（RED），编程（黄）不再接入端口。
(3) 通道分配
在基于STC8H1K28双轴机械臂驱动模块1具有两个通道的步进电机控制和角度传感器。将通道1（步进电机控制、角度传感器读取）分配给肩关节；将通道2（步进电机控制，角度传感器读取）分配给肘关节。
2.连接控制模块
按照上述的通道方案，将肘关节、肩关节的部件电机驱动端口、角度传感器端口分别进入实验电路板的相应的端口。具体参见上面的“通道分配”中的示意图。
▲ 控制模块与关节步进电机和角度传感器相连
3.WiFi调试
▲ 连接有WiFI调试下载器的系统
4.步进电机工作电源
在 STC8K28步进电机ULC2003触发器 测试两个步进电机需要供电电压大于15V，这里使用电源24V开关电源进行供电。
▲ 供电电源：24V，+5V
电源同时提供+5V，+24V 电压。供电电流最大4.6A。
使用ADJ电位器可以同时提高和降低输出的+5V, +24V电压。
02初步运动控制2
直接利用在基于STC8H1K28双轴机械臂驱动模块中的串口命令，通过WiFi调试界面发送指令控制双轴机械臂运动。
1.控制肘关节运动
通过串口命令step2实现肘关节的运动:
step2 2000
step2 -2000
step2的命令参数： n>0n > 0n>0:肘臂顺时针旋转； n<0n < 0n<0肘臂逆时针旋转。（从顶视图来看。）
▲ 肘关节运动
2.控制肩关节运动
step1 1000
step1 -1000
step1的参数：n>0n > 0n>0肩部顺时针旋转。n<0n < 0n<0逆时针旋转；（从顶视图来看）。
▲ 肩关节运动
通过上面肩关节和肘关节运动情况来看，证明了以下两方面的事实：
- 42HS48EIS的闭环步进电机。这款步进电机在带动负载运动过程中，不会丢步，并对位置（步数）进行闭环跟踪控制。那么42HS48EIS的闭环控制特性究竟是什么？这需要进一步通过它的数据手册来了解。
- 在肩关节和肘关节中，存在着较大的振荡情况。这主要是运动手臂本身转动惯量所引起的。那么在后面的控制指令中如何进一步来消除这种过冲，需要在算法上来实现运动阻尼。
▲ 肩关节运动对应的角度变化数值
▲ 肘关节运动对应角度变化
3.肩关节与肘关节角度极限
(1) 旋转方向与角度增减
使用angle命令读取肘关节与肩关节的角度信息，使用step1（肩关节运动命令），step2（肘关节运动命令）驱动两个运动，可以证明：
- 两个轴的角度：在顺时针旋转的时候减少，在逆时针旋转的时候增加。
(2) 两个轴的极限位置
通过将肩关节和肘关节的电机使能取消，手动将肩关节和肘关节旋转的极限位置。使用串口命令angle，可以获得在各个极限位置下角度的数值。
- 肘关节顺时针旋转，角度变化为：14526 --> 1122
▲ 肘关节的角度变化范围
- 肩关节顺时针旋转，角度变化为：3810 -->10800
▲ 肩关节角度范围
4.旋转与角度之比
- 42HS48EIS步进电机细分设置： SW2345=0001，对应40000步一个周角。
脉冲与角度之间的比值。使用move1(move2)命令，然后测量angle的变化。
■ 表格:move 10000前后的角度变化
| 肩关节角度 | 肘关节角度 |
|---|---|
| 10781 | 3697 |
| 14851 | 7773 |
| 肩关节变化 | 肘关节变化 |
| 4070 | 4076 |
■ 表格:move 10000前后的角度变化
| 肩关节角度 | 肘关节角度 |
|---|---|
| 14851 | 7773 |
| 2556 | 11889 |
| 肩关节变化 | 肘关节变化 |
| 4033 | 4116 |
对于肩关节角度：Astart=10781A_{start} = 10781Astart=10781，Astop=2556A_{stop} = 2556Astop=2556。考虑到其中的角度可能经过了16328（2142^{14}214），所以，实际角度变化范围：ΔA=214−Astart+Astop=8159\Delta A = 2^{14} - A_{start} + A_{stop} = 8159ΔA=214−Astart+Astop=8159
对于肘关节：Astart=3697A_{start} = 3697Astart=3697，Astop=11889A_{stop} = 11889Astop=11889。实际角度变化：ΔA=Astop−Astart=11889−3697=8192\Delta A = A_{stop} - A_{start} = 11889 - 3697 = 8192ΔA=Astop−Astart=11889−3697=8192
通过上述分析，可以看到两个角度基本上都是旋转了213=81922^{13} = 8192213=8192，也就是半圆的角度。对应的移动角度为20000。
查看两个步进电机的设置，SW2,3,4,5=0000（ 42HS48EIS ），电机旋转一周为40000步。所以上述分析与电机的设置是相符合的。
- 42HS48EIS步进电机细化设置： SW2345=0001，对应周角旋转步数51200
使用命令move12移动20000步。
| 肩关节角度 | 肘关节角度 |
|---|---|
| 2625 | 11971 |
| 12617 | 5562 |
| 角度差 | 角度差 |
| 6392 | 6409 |
运动20000步，对应的角度为：
2000051200×360=140.625{{20000} \over {51200}} \times 360 = 140.6255120020000×360=140.625
对应的14bit的角度为：
2000051200×214=6400{{20000} \over {51200}} \times 2^{14} = 64005120020000×214=6400
从上面的数据可以看到实际测量的角度与理论值之间相差±10\pm 10±10之内。
- 结论：
将42HS48EIS步进细分设置为：51200，转动与角度只比：
ΔAngle:ΔStep=21451200\Delta Angle:\Delta Step = {{2^{14} } \over {51200}}ΔAngle:ΔStep=51200214
5.试验故障
★ 在调试过程中，肘关节电机输出与机械部分滑脱了，现在已经无法带动大臂旋转。
上述的试验故障，最终通过白超的实验，验证应该数据步进电机的角度偏差范围超出范围决定的。这个故障可以通过步进电机上的指示灯闪烁的模式来确定。
闪烁5次停3秒：表示控制偏差超出范围。
03关节运动与角度
1.肘关节运动180°对应角度变化
肘关节逆时针运动180°对应的角度变化：
▲ 肘关节运动180°对应的角度变化
▲ 肘关节运动
2.肩关节运动180对应的角度变化
▲ 肩关节运动180°对应角度传感器变化值
▲ 机械臂肩部 运动
显示了对于肩关节角度传感器在运动范围之内有一个角度突变的过程。这是由于角度传感器量程具有有限的bit。
为了便于在程序里判断，对于肩关节的角度做如下的修正：
假设原来的肩关节的角度值：SorigS_{orig}Sorig，那么修正之后的数值为：Snew=mod(Sorig+6000,214)S_{new} = \bmod \left( {S_{orig} + 6000,\,\,2^{14} } \right)Snew=mod(Sorig+6000,214)
对应的变化为：
▲ 肩关节角度修正之后的变化规律
修正后的肩关节的变化就没有突变了。
#!/usr/local/bin/python
# -*- coding: gbk -*-
#============================================================
# TEST1.PY -- by Dr. ZhuoQing 2020-08-22
#
# Note:
#============================================================
from headm import *
from tsmodule.tsstm32 import *
angledim = []
for i in range(100):stm32cmd('CLEAR')stm32cmd('step1 -256')time.sleep(1)stm32cmd('angle')time.sleep(0.2)angle = stm32memo(1)angledim.append(angle[0])printff(i, angle[0])
tspsave('Angle1', angle=angledim)
printf('\a')
plt.plot(angledim)
plt.xlabel("Step")
plt.ylabel("Angle")
plt.grid(True)
plt.tight_layout()
plt.show()
#------------------------------------------------------------
# END OF FILE : TEST1.PY
#============================================================
※ 结论
将基于STC8H1K28双轴机械臂驱动模块与双轴机械臂组装，进行了初步的调试。需要进行如下的改动：
- 对于控制序号结合速度和位置来消除运动中的振荡；
- 在肩关节在调试过程中输出与大臂之间滑脱。需要在机械结构上能够进一步避免这种情况的产生。
控制模块AD工程文件:AD\XQWF\2020\机械臂\CNT2AXESSTC8H.PcbDoc ↩︎
单片机C51控制程序:C51\STC\Project\XQWF\2020\STC8H2AXES\STC8H2AXES.uvproj ↩︎
双轴机械臂调试：步进电机42HS348E,BH32角度传感器，MCU:STC8H1K28相关推荐
- 基于STC8H1K28的双轴机械臂驱动模块:步进电机42HS348E,BH32角度传感器
作者:卓晴博士,清华大学自动化系 更新时间:2020-08-08 Saturday ■ 设计背景 这是一款用于化学实验室样品上样器的机械臂.设置有肘关节.肩关节以及上下移动关节. ▲ 双轴机械臂结构 ...
- 双轴机械臂位置闭环控制：STC8H1K28，42HS48EIS,BH32
■ 背景介绍 对于 一款用于化学实验室样品操作机械臂 的调试过程中,在博文 双轴机械臂调试:步进电机42HS348E,BH32角度传感器,MCU:STC8H1K28 可以看到初步的通过带有 闭环控制的 ...
- 组装肩部带有减速器双轴机械臂组装与调试
➤ 00背景 在 增加了机械爪的双轴机械臂 安装调试之后, 发现进行平顺控制效果不好 ,因此在原来的基础上进行了如下的改动: 肩部和肘部的角度传感器采用了: 角度编码器 ST-3806-15-RS 读 ...
- 双轴机械臂串口控制命令开发与测试：STM32F103控制板,简易调试命令集合
▌01 底层串口控制命令 1.调试说明 本文是继 调试机械臂一体化控制电路 博文中对于 两轴机械臂+机械爪整体控制板设计与机械爪控制调试 在 基于STM32F103双轴机械臂完整电路板 控制下进行串口 ...
- 双轴机械臂建模分析数据
作者:卓晴博士,清华大学自动化系 更新时间:2020-08-19 Wednesday ■ 背景 在 对于实验室双轴机械臂进行运动调试过程中,设计最后的控制器需要对运动对象进行力学建模分析.利用肩关节. ...
- 双轴机械臂中的闭环步进电机平顺控制算法： 42HS48EIS，57HS
■ 实验背景 在 两轴机械臂+机械爪整体控制板设计与机械爪控制调试 的基础上对于机械臂各关节进行了 双关节机械臂+机械爪运动控制 ,其中存在的主要问题还是肩关节运动不平稳的情况. ▲ 机械臂肩部运动 ...
- 基于STM32F103双轴机械臂完整电路板设计
➤01 机械臂设计 在 基于STM32对于三轴机械臂控制器设计 设计了机械臂的控制电路板.采用了双板分开设计方式.并分别进行了如下的测试: 1. 对于STM32F103三轴机械臂控制器进行基本 ...
- 两轴机械臂+机械爪整体控制板设计与机械爪控制调试
简 介: 在实验室样品自动上样双轴机械臂调试之后,出现了肩关节的运动力矩不足,这里使用了57HSXXXX步进电机进行增加力矩.下面是相关的调试过程. 关键词: 两轴机械臂,机械爪,上样机械臂 01为什 ...
- 对于STM32F103控制的三轴机械臂基本功能测试-关节转动控制
➤01 机械臂调试 1.简介 对于 基于STM32对于三轴机械臂控制器设计 的设计已经进行了如下的调试: 对于STM32F103三轴机械臂控制器进行基本功能测试-关节角度读取 对于STM32F103三 ...
最新文章
- 哥们，你侵权了，哥有权告你去！
- SAP采购订单下传SRM
- android exchange服务,带有“ Service com.android.exchange.ExchangeService
- `CXXABI_1.3.8' not found (required by /usr/lib/x86_64-linux-gnu/libicuuc.so.55)
- nn.Conv2d中padding详解【pytorch学习】
- java 方法返回的值,java方法返回值问题
- 我们计划招收300名电力人，免费学习CAD。
- android开发 常用技巧
- sql 无法删除当前数据库，因为当前数据库正在使用
- 相信应该有百分九十的男生看见这个东西是这个状态吧？
- MySQL5.7 编译安装
- ubuntu 16.04 安装ros kinetic
- swift的设计原则_iPhone12 的UI设计规范如何做？
- Boost高性能网络编程
- JavaScript之Ajax-1 Ajax(Ajax原理、Ajax对象属性和方法)
- Linux局域网文件分享系统Samba
- 【转】C#字符串转换为日期
- 控件无法安装的问题-Unable to execute file
- window计算机截屏快捷键,windows截图工具快捷键,win7截屏快捷键是哪个
- Swift GYB 简易教程