让三只小舵机把照片画到纸上
用树莓派和3只模拟舵机驱动两段木条,让一支笔画出线稿。固定8cm+8cm基础结构,提供原作者装配实拍、逐针接线、采购入口和从画方框到照片转线稿的步骤。约¥150–350为复用部分材料时的规划估算;全新原厂海外采购另核。Daniele Procida开源项目,有外部制作者教程,非本站实机测试。
alan000
BrachioGraph 原作者开放文档 / GitHub 2019
先找齐能组成一台绘图仪的零件,给三只舵机贴上用途标签。
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 为内/外臂。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),粘牢垫片与底板。

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

侧面可见肩电机下方的垫片。Daniele Procida,MIT。
检查:胶冷却后轻推电机外壳,底座不摇晃;轴中心仍在原点,木臂安装后的旋转平面高于底板。
两段臂长都量轴心之间的距离,而不是木条总长。
1. 把第一根木条平放,将两个舵盘粘在同一面,两处中心螺孔间距精确为 80 mm。胶留在舵盘外缘,保持中心孔及齿槽清洁。先不要把这根内臂扣到舵机轴上。

内臂两个舵盘中心相距 80 mm。Daniele Procida,MIT。
1. 在第二根木条一端粘肘舵机,在另一端粘衣夹。先夹入笔作定位:从肘轴中心到笔尖在纸面上的投影距离为 80 mm,再固定衣夹。
2. 在笔旁固定抬笔舵机,使它的舵盘能转到纸面并把笔端顶起。留出舵盘转动空间,胶不接触输出轴,电线沿木条收拢。

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

抬笔舵盘向下顶住纸面时,笔尖离开纸面。Daniele Procida,MIT。
检查:胶完全冷却后,两处 80 mm 尺寸保持不变,衣夹夹笔不滑动。首次通电前,肩、肘与内臂仍分离。
完成 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
```

固定版本 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`,待系统停止活动后拔掉电源。
用面包板把三个电机共用的电源分出来,信号线分别接到指定 GPIO。

原作者面包板图;图中为另一款 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°,肘端仍空着。Daniele Procida,MIT。
手离开机械臂后依次执行:
```
bg.set_angles(0, 90)
bg.park()
```
内臂应顺时针转至约 0°,再返回 −90°。
1. 将外臂的肘舵机轴扣入内臂另一端舵盘,外臂与内臂约成 90°;固定中心螺钉,让信号线有松弛余量。

装上外臂:两臂接近直角,笔端朝绘图区。Daniele Procida,MIT。
```
bg.set_angles(-90, 120)
bg.park()
```
检查:肩臂保持在 −90°,外臂从相对 90° 顺时针转约 30°,随后回位。若扫向底座、拉紧电线或发出持续堵转声,立即断电,检查安装角度和对应信号线。
让笔能可靠抬起,并把两只电机的实际归位值记录下来。
```
bg.pen.down()
bg.pen.up()
```

落笔时笔尖接触纸面,抬笔时舵盘支起笔端。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])
```

作者的首个方框:可先接受轻微波浪,再做回差校准。Daniele Procida,MIT。
检查:矩形左下角为 (−2,7)、右上角为 (2,11),四边约 4 cm,转场时笔尖抬起。位置或方向明显错误时,先复核轴心距、安装角度和三路信号。
保存本机参数,让下次启动直接使用;通过双向测试图减小回差。
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")` 画仓库自带示例。

作者双向测试图:比较同一路径从两个方向靠近时的偏移。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)
```

本次运行 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 和一张成品照片,下一次即可复用校准与轨迹。