“三轴编程”通常指在数控加工（CNC）、机器人控制或三维运动控制中，对 X、Y、Z 三个正交直线轴进行协同运动的编程。它不特指某一种语言，而是一种运动控制逻辑，常见于 G 代码（ISO 6902 标准）、Python（配合运动控制器如 GRBL、Arduino + AccelStepper、ROS、or PyGame/PyBullet 仿真）、或 PLC 梯形图等场景。 下面以**最典型、最易理解的三轴直线插补（Linear Interpolation）编程实例**为例，使用 **Python + Matplotlib 可视化模拟**，实现一个简单的三轴联动轨迹（例如：从原点 (0,0,0) 到目标点 (10,5,3) 的匀速直线运动），并生成对应的 G 代码片段（符合通用 CNC 规范）。 --- ### ✅ 示例目标： - 在三维空间中规划一条三轴（X/Y/Z）同步直线运动路径； - 用 Python 计算离散插补点（等时间/等步长）； - 可视化轨迹； - 输出标准 G 代码（G01 直线插补）； - 说明关键概念：插补、脉冲分配、进给速度、坐标系。 --- ### 🧾 Python 实现（含注释与可视化） ```python import numpy as np import matplotlib.pyplot as plt from mpl_toolkits.mplot3d import Axes3D # === 参数设定 === start = np.array([0.0, 0.0, 0.0]) # 起点 (X, Y, Z) 单位：mm end = np.array([10.0, 5.0, 3.0]) # 终点 feed_rate = 150.0 # 进给速度 mm/min total_time = 2.0 # 总运动时间（秒） n_steps = 50 # 插补总点数（分辨率） # === 时间序列 & 线性插补 === t = np.linspace(0, total_time, n_steps) # 匀速直线插补：pos(t) = start + t/total_time * (end - start) trajectory = np.outer(1 - t/total_time, start) + np.outer(t/total_time, end) # 上式等价于： # trajectory = np.array([start + (end - start) * (ti / total_time) for ti in t]) # === 可视化 === fig = plt.figure(figsize=(10, 8)) ax = fig.add_subplot(111, projection='3d') ax.plot(trajectory[:, 0], trajectory[:, 1], trajectory[:, 2], 'b-o', markersize=3, linewidth=2, label='Trajectory') ax.scatter(*start, color='green', s=100, label='Start (0,0,0)', depthshade=False) ax.scatter(*end, color='red', s=100, label='End (10,5,3)', depthshade=False) ax.set_xlabel('X (mm)') ax.set_ylabel('Y (mm)') ax.set_zlabel('Z (mm)') ax.set_title('3-Axis Linear Interpolation (X-Y-Z Synchronized Motion)') ax.legend() ax.grid(True) plt.show() # === 生成 G 代码（G01 直线插补，带 F 进给）=== print("Generated G-code (G01 linear interpolation):") print("G21 ; Set units to mm") print("G90 ; Absolute positioning") print("G00 X0.0 Y0.0 Z0.0 ; Rapid move to start (optional)") print("G01 F{:.1f} ; Set feed rate".format(feed_rate)) for i, (x, y, z) in enumerate(trajectory): # 四舍五入到 0.01mm 精度（实际 CNC 常见） print("G01 X{:.2f} Y{:.2f} Z{:.2f} ; Step {}".format(x, y, z, i+1)) print("M30 ; Program end") ``` --- ### 🔍 关键解释： | 概念 | 说明 | |------|------| | **三轴联动（3-axis simultaneous control）** | X/Y/Z 电机必须严格按比例输出脉冲，保证合成矢量方向恒定——即“插补”。本例用数学线性插值模拟该过程。 | | **G01 直线插补** | CNC 中最基础的运动指令，控制器内部通过算法（如DDA数字微分分析器或Bresenham变种）实时分配各轴脉冲，使刀具沿直线运动。 | | **进给速度 `F`** | 单位为 mm/min（或 inch/min），是**合成速度**（即空间直线速率），不是单轴速度。控制器自动分解为各轴分速度：<br> `v_x = F × (Δx/L), v_y = F × (Δy/L), v_z = F × (Δz/L)`，其中 `L = √(Δx²+Δy²+Δz²)`。 | | **为什么用等时间采样？** | 实际 CNC 使用高频率定时中断（如 1kHz）做插补周期，每周期计算一次各轴目标位置，再通过位置环驱动伺服。本例 `n_steps` 模拟了插补周期数。 | | **G21/G90 是什么？** | `G21`: 公制单位（mm）；`G90`: 绝对坐标编程（相对于工件原点），区别于 `G91`（增量）。 | > 💡 提示：真实 CNC 系统（如 Mach3、LinuxCNC、GRBL）会接收 G 代码流，由固件完成底层插补和 PWM/脉冲生成；而本例是**上位机轨迹规划层**的简化演示。 --- ### 📌 扩展思考（可选增强）： - 加入圆弧插补（G02/G03）→ 需参数化圆方程 + 角度步进； - 加入加减速（S-curve 或梯形速度曲线）→ 替换 `t` 为非线性时间函数； - 导出为 `.gcode` 文件并用 [cncjs](https://github.com/cncjs/cncjs) 或 [Universal G-code Sender](https://github.com/winder/Universal-G-Code-Sender) 加载仿真； - 接入 Arduino + GRBL：用 `serial.write()` 发送 G 代码行。 ---