用木条和舵机搭建画画机器人|BrachioGraph

让三只小舵机把照片画到纸上

用树莓派和3只模拟舵机驱动两段木条,让一支笔画出线稿。固定8cm+8cm基础结构,提供原作者装配实拍、逐针接线、采购入口和从画方框到照片转线稿的步骤。约¥150–350为复用部分材料时的规划估算;全新原厂海外采购另核。Daniele Procida开源项目,有外部制作者教程,非本站实机测试。

alan000

BrachioGraph 原作者开放文档 / GitHub 2019

参数信息

基础构型绘图范围
约14 × 9 cm

复现文档

清点三只舵机并认清肩、肘和抬笔位置

先找齐能组成一台绘图仪的零件,给三只舵机贴上用途标签。

1. 准备 Pi Zero WH、microSD、5 V 2.5 A MicroUSB 电源、3 只模拟角度型 SG90、各自的舵盘与中心螺钉。另备面包板、5 根母公线和至少 9 根公公线。

2. 准备 2 根约 10 cm 的平直木条、1 个能夹紧笔的衣夹、A4 硬底板、4–6 mm 厚的垫片、热熔胶、A4 模板纸、A5 绘图纸、低黏胶带和轻压出墨的笔。

3. 在电机壳体贴“肩”“肘”“抬笔”标签:肩电机固定在底板,肘电机固定在外臂,抬笔电机位于笔旁。舵机包装应标明模拟角度型 SG90;连续旋转型无法按本教程定位。

4. 暂时保持所有电源断开,先取出舵盘和螺钉,放进小盒以免丢失。

![部件位置:shoulder 为肩电机,elbow 为肘电机,lifting 为抬笔电机,inner/outer 为内/外臂](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/87bd0b103cb34639bf730e1cbdfc0727.jpg)

部件位置:shoulder 为肩电机,elbow 为肘电机,lifting 为抬笔电机,inner/outer 为内/外臂。Daniele Procida,MIT。

检查:三只电机、两段臂材和夹笔组件齐全,输出轴及舵盘没有破损。

按网格原点固定肩电机

把肩轴固定在网格的 (0,0),为后续测角和画框建立同一基准。

1. 下载 [定位网格 PDF](https://github.com/evildmp/BrachioGraph/raw/a2825e42edbccde866cc070e50db5721a153a772/docs/supporting-files/template-grid.pdf),用 A4 纸按“实际大小/100%”打印。用直尺检查 0 到 5 的网格跨度为 5 cm。

2. 把模板平整贴到硬底板上,四边用胶带固定。找到横纵坐标的 (0,0) 交点。

3. 将硬卡片叠成约 4–6 mm 厚的垫片,粘在肩舵机底部;再将舵机输出轴中心对准 (0,0),粘牢垫片与底板。

![肩轴中心对准模板原点](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/6dc7392040f64e329eea8b004770def1.jpg)

肩轴中心对准模板原点。Daniele Procida,MIT。

![侧面可见肩电机下方的垫片](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/d2e04263268e4e71ac5d0c5d208d769d.jpg)

侧面可见肩电机下方的垫片。Daniele Procida,MIT。

检查:胶冷却后轻推电机外壳,底座不摇晃;轴中心仍在原点,木臂安装后的旋转平面高于底板。

做两段 80 mm 机械臂和夹笔组件

两段臂长都量轴心之间的距离,而不是木条总长。

1. 把第一根木条平放,将两个舵盘粘在同一面,两处中心螺孔间距精确为 80 mm。胶留在舵盘外缘,保持中心孔及齿槽清洁。先不要把这根内臂扣到舵机轴上。

![内臂两个舵盘中心相距 80 mm](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/d77f665bfc9e4edeb73253404c5dc605.jpg)

内臂两个舵盘中心相距 80 mm。Daniele Procida,MIT。

1. 在第二根木条一端粘肘舵机,在另一端粘衣夹。先夹入笔作定位:从肘轴中心到笔尖在纸面上的投影距离为 80 mm,再固定衣夹。

2. 在笔旁固定抬笔舵机,使它的舵盘能转到纸面并把笔端顶起。留出舵盘转动空间,胶不接触输出轴,电线沿木条收拢。

![外臂:肘轴到笔尖投影的距离为 80 mm](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/4545b3b450614e3a9931607ea737ff40.jpg)

外臂:肘轴到笔尖投影的距离为 80 mm。Daniele Procida,MIT。

![抬笔舵盘向下顶住纸面时,笔尖离开纸面](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/53a43c3481134ceea7f67b0c7d38f4b8.jpg)

抬笔舵盘向下顶住纸面时,笔尖离开纸面。Daniele Procida,MIT。

检查:胶完全冷却后,两处 80 mm 尺寸保持不变,衣夹夹笔不滑动。首次通电前,肩、肘与内臂仍分离。

给 Pi Zero WH 安装系统和控制程序

完成 Wi-Fi 登录、虚拟环境和固定版本代码安装,再进入接线。

1. 在电脑用 Raspberry Pi Imager 为 Pi Zero WH 写入 Raspberry Pi OS Bullseye Lite 32-bit。写卡会清空所选 microSD,先确认卡内无须保留的文件。设置自己的用户名、密码、2.4 GHz Wi-Fi,并启用 SSH。

2. 将卡插入 Pi,通过标有 PWR IN 的 MicroUSB 口供电。电脑连接同一网络,在终端输入 `ssh 你的用户名@树莓派IP`;IP 可在路由器的设备列表查看。

3. 登录后逐段执行以下命令。系统包名称对应 Bullseye;若安装报“找不到软件包”,先用 `cat /etc/os-release` 确认系统版本。

```

sudo apt update

sudo apt install -y python3-venv python3-tk pigpiod libjbig0 libjpeg-dev liblcms2-2 libopenjp2-7 libtiff5 libwebp6 libwebpdemux2 libwebpmux3 libzstd1 libatlas3-base libgfortran5 git

cd ~

python3 -m venv env

source env/bin/activate

git clone https://github.com/evildmp/BrachioGraph.git

cd BrachioGraph

git checkout a2825e42edbccde866cc070e50db5721a153a772

python -m pip install -r requirements.txt

python -m pip check

```

![](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/1f1cb2d8c11840839233497f1166a7cc.png)

固定版本 requirements.txt 的真实页面:核对这些依赖名及版本约束,安装使用上方整份文件。

再做无 GPIO 的导入检查:

```

python -c "from brachiograph import BrachioGraph; bg=BrachioGraph(virtual=True); print(bg.virtual)"

```

检查:`pip check` 返回 `No broken requirements found`,最后一条命令显示虚拟初始化并输出 `True`。完成后执行 `sudo shutdown -h now`,待系统停止活动后拔掉电源。

断电连接 5 V、地线和三路信号

用面包板把三个电机共用的电源分出来,信号线分别接到指定 GPIO。

![原作者面包板图;图中为另一款 40 针树莓派,Pi Zero WH 使用相同物理针号](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/f74a648357ea4d9585fb90552070c419.png)

原作者面包板图;图中为另一款 40 针树莓派,Pi Zero WH 使用相同物理针号。Daniele Procida,MIT。

1. 确认 Pi 的 USB 电源及其他供电都已拔掉。按 Pi Zero WH 的 40 针排针图找到物理针 1,识别奇数排和偶数排,再数到本步骤所列针脚。

2. 三个舵机的电源线接面包板同一电源轨,再接 Pi 物理针 2(5 V);三个地线接另一轨,再接物理针 6(GND)。常见电源线为红色、地线为棕色,最终以电机标识为准。

3. 肩信号接物理针 8(BCM14);肘信号接物理针 10(BCM15);抬笔信号接物理针 12(BCM18)。物理针号用于找插孔,BCM 号用于软件。

4. 沿每根线从舵机追到 Pi,逐一核对。电源轨如果从中间断开,仅桥接同一极性的两段;5 V 轨和地轨始终分开。

检查:Pi 端共占用 2、6、8、10、12 五个物理针脚,接头没有错位跨一孔,5 V 没有接入 GPIO 信号脚。保留肩、肘空载,下一步再通电。

空载归位,再依次装上两臂

先让电机停在程序基准位置,再装木臂,避免第一次启动时突然扫动。

```

sudo pigpiod

source ~/env/bin/activate

cd ~/BrachioGraph

python

```

出现 `>>>` 后输入:

```

from brachiograph import BrachioGraph

bg = BrachioGraph()

```

肩、肘先不连接内臂;确认程序没有报告 `running in virtual mode`,三只舵机停稳后再按下列顺序操作。若只进入虚拟模式,检查 pigpiod 是否启动。

1. 将内臂的一端装到肩轴,使内臂沿模板 −90° 方向。扶住舵盘,拧入随舵机提供的中心螺钉,不强行扭动电机轴。

![只装内臂:沿模板 −90°,肘端仍空着](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/025a182854524a9391cbae30bf7288db.jpg)

只装内臂:沿模板 −90°,肘端仍空着。Daniele Procida,MIT。

手离开机械臂后依次执行:

```

bg.set_angles(0, 90)

bg.park()

```

内臂应顺时针转至约 0°,再返回 −90°。

1. 将外臂的肘舵机轴扣入内臂另一端舵盘,外臂与内臂约成 90°;固定中心螺钉,让信号线有松弛余量。

![装上外臂:两臂接近直角,笔端朝绘图区](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/29f3ce1ced50432c9cf8826e4d728751.jpg)

装上外臂:两臂接近直角,笔端朝绘图区。Daniele Procida,MIT。

```

bg.set_angles(-90, 120)

bg.park()

```

检查:肩臂保持在 −90°,外臂从相对 90° 顺时针转约 30°,随后回位。若扫向底座、拉紧电线或发出持续堵转声,立即断电,检查安装角度和对应信号线。

调笔高、测归位脉宽并画 4 cm 方框

让笔能可靠抬起,并把两只电机的实际归位值记录下来。

```

bg.pen.down()

bg.pen.up()

```

![落笔时笔尖接触纸面,抬笔时舵盘支起笔端](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/53a43c3481134ceea7f67b0c7d38f4b8.jpg)

落笔时笔尖接触纸面,抬笔时舵盘支起笔端。Daniele Procida,MIT。

1. 调整衣夹中的笔高及抬笔舵盘位置:落笔轻压即可连续出线,抬笔高出纸面约 1–2 mm。固定绘图纸后重复抬落,确认抬笔不拖线。

2. 执行 `bg.park()`,再输入 `bg.set_pulse_widths(1500, 1500)`。两个数分别控制肩和肘,单位为 μs。

3. 一次只改变一个数、幅度不超过 100 μs,观察内臂是否对准 −90°、外臂是否与其成 90°。例如 `bg.set_pulse_widths(1400, 1500)` 只微调肩。记录两只电机最终数值为“肩归位脉宽”和“肘归位脉宽”。

4. 用自己的两个整数重新建立对象:将下面输入提示中的值填为刚记录的数值。

```

shoulder_pw = int(input("肩归位脉宽(μs):"))

elbow_pw = int(input("肘归位脉宽(μs):"))

bg = BrachioGraph(servo_1_parked_pw=shoulder_pw, servo_2_parked_pw=elbow_pw)

bg.box(bounds=[-2, 7, 2, 11])

```

![作者的首个方框:可先接受轻微波浪,再做回差校准](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/106f86a10b134b6f89fff3b92a07f619.jpg)

作者的首个方框:可先接受轻微波浪,再做回差校准。Daniele Procida,MIT。

检查:矩形左下角为 (−2,7)、右上角为 (2,11),四边约 4 cm,转场时笔尖抬起。位置或方向明显错误时,先复核轴心距、安装角度和三路信号。

把校准存入 custom.py 并比较正反画线

保存本机参数,让下次启动直接使用;通过双向测试图减小回差。

1. 在 Python 输入 `exit()` 返回终端,运行 `nano custom.py`。粘贴以下内容,把两个 `None` 分别替换成上一步记录的整数。

```

from brachiograph import BrachioGraph

SHOULDER_PW = None # 替换为肩归位脉宽

ELBOW_PW = None # 替换为肘归位脉宽

if SHOULDER_PW is None or ELBOW_PW is None:

raise ValueError("请先填写两只舵机的归位脉宽")

bg = BrachioGraph(

servo_1_parked_pw=SHOULDER_PW,

servo_2_parked_pw=ELBOW_PW,

hysteresis_correction_1=0,

hysteresis_correction_2=0,

)

```

1. 按 Ctrl+O、回车保存,Ctrl+X 退出。重新运行 `python`,输入 `from custom import bg`,再输入 `bg.test_pattern(both=True)`。观察同一条网格线正向和反向是否重合。

2. 若两向有稳定偏移,退出 Python,在 custom.py 中将两项 `hysteresis_correction` 从 0 改为作者示例的 10,重新启动并比较。每轮只改一个参数并留存测试纸;作者给出的探索区间为 7–20,选择能缩小本机偏差的值。

3. 每次改文件后都退出旧 Python 会话再导入。最后运行 `bg.park()` 检查归位,运行 `bg.plot_file("images/demo.json")` 画仓库自带示例。

![作者双向测试图:比较同一路径从两个方向靠近时的偏移](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/b297d12e2c93456f8e29e2f834fd6e55.jpg)

作者双向测试图:比较同一路径从两个方向靠近时的偏移。Daniele Procida,MIT。

检查:重启后仍能正确归位,双向线条比初始更接近。若整图持续比例变形,再按源教程测量角度系数;本轮先完成归位与回差,不同时改变多组参数。

把图片转换成轨迹并交给树莓派绘制

在电脑生成 SVG 预览和 JSON 轨迹,检查后只把轨迹文件传给 Pi。

1. 在电脑准备 Python 3 环境,下载同一固定版本的 BrachioGraph 仓库。在仓库目录创建虚拟环境并安装转换依赖。下面为 macOS/Linux 终端命令:

```

python3 -m venv image-env

source image-env/bin/activate

python -m pip install opencv-python-headless Pillow numpy

python

```

先转换仓库自带的 africa.jpg:

```

from linedraw import image_to_json

image_to_json("africa", draw_contours=2, draw_hatch=16)

```

![](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/03d49936-174a-43a9-a597-c9427d2787d6/files/image/4c76e98e54d74d948459e8239e0cd8bd.png)

本次运行 linedraw 生成的 africa.svg 预览:轮廓加交叉排线,共 220 条路径。

1. 打开 `images/africa.svg` 检查轮廓和密度。换自己的图片时放入 images 目录,改命令中的文件名;`draw_contours` 或 `draw_hatch` 设为 0 可关闭对应线型,数值越小通常越密。

2. 退出电脑上的 Python,在终端用 `scp images/africa.json 你的用户名@树莓派IP:~/BrachioGraph/images/` 传输轨迹。

3. 回到 Pi,激活环境并进入仓库,启动 Python,依次输入 `from custom import bg` 与 `bg.plot_file("images/africa.json")`。清空机械臂扫过区域,观察首条路径后再继续整图。

完成检查:笔在不相连的线段之间会抬起,轮廓落在固定纸面内。保存生成的 SVG、JSON、custom.py 和一张成品照片,下一次即可复用校准与轨迹。

相关科技单元