简介圆弧插补是数控加工与运动控制中的关键环节决定刀具或执行机构能否按圆弧轨迹平稳运动。这份资源以C语言实现圆弧插补核心代码面向数控系统开发者、嵌入式工程师以及机械电子类专业学生适用于学习插补原理、调试运动控制算法或完成课程设计等场景。压缩包内共包含2个文件以.c源码文件为主另含辅助文件整体体积仅3KB结构紧凑、便于快速定位核心逻辑。已有658人学习了该资源。通过这份源码读者可以拆解圆弧插补的坐标计算、象限判断、步进脉冲输出等典型步骤结合简要注释理解整套算法流程同时精简的代码也适合作为基础模板迁移到自己的控制平台或继续扩展为顺/逆圆插补、多轴联动等功能从而实现从原理到实践的有效跨越。1. 圆弧插补在运动控制里为什么是分水岭数控制造、点胶机、激光切割和直角坐标机器人里直线插补是入门圆弧插补才是分水岭。很多人写运动控制程序时习惯把圆弧切成几百段短直线去逼近加工出来发现内圈和外圈都出现明显的多边形棱边。问题不在于直线段数不够而在于没有理解圆弧插补的本质用误差可控的微线段逼近理想圆弧在每个插补周期里输出坐标增量让轨迹速度保持连续而不是靠“切得足够细”硬扛。下面从圆弧插补的数学模型讲起把逐点比较、DDA 和数据采样三种实现思路讲清楚再给出一段能直接改来用的数据采样圆弧插补代码最后落到参数标定、圆度误差排查和实际加工里的限速与刀痕控制。适合运动控制卡开发、CNC 系统集成、自动化设备软件调试的工程师也适合刚接触插补算法、想搞明白 G02/G03 背后到底在算什么的人。2. 圆弧插补的三种算法路径与精度边界2.1 逐点比较法一个点一个点校正偏差最早的开环数控系统常用逐点比较法典型场景是普车数控改造和步进电机直接驱动的简单控制器。核心思想是每走一步就比较当前坐标点与理想圆弧的相对位置如果点在圆外下一步就朝圆心方向走一步如果点在圆内下一步就朝远离圆心的方向走一步。实际走的轨迹是阶梯状锯齿线每一步只有八个方向可选。偏差判别式是 F x² y² - R²。F 0 表示点在圆上F 0 表示点在圆外F 0 表示点在圆内。插补器根据 F 的符号决定下一步的进给方向。这个算法实现简单脉冲频率直接决定速度但它的分辨率被脉冲当量锁死。比如插补一个半径 20 mm 的 90° 圆弧脉冲当量按 0.001 mm 算总步数大约三万多步每一步都可能产生一个脉冲当量的阶梯误差。逐点比较法能保证误差不超过一个脉冲当量所以对没有位置反馈的步进系统来说它已经是精度下限的保证。但现代伺服系统普遍带编码器闭环再用这种算法就浪费了硬件能力现在新系统几乎不把它作为主插补器只在老式步进控制板里还能见到。2.2 DDA 数字积分法用积分器同时输出两轴增量数字积分法也就是 DDADigital Differential Analyzer把圆弧看作两个坐标方向对时间积分的结果。对圆的参数方程求导X 方向增量与 Y 坐标相关Y 方向增量与 X 坐标相关两者互为交换。用两个数字积分器分别累加就能在每个插补周期输出均匀的坐标增量。DDA 比逐点比较法输出更均匀没有锯齿状阶梯对速度和加速度控制也更友好所以七八十年代的大量数控系统和机器人控制器都建立在 DDA 基础上。但它有一个工程上的别扭之处积分溢出处理和插补速度上限耦合在一起修改进给速度时要同步调整积分系数否则进给速度一提上去积分累加器先溢出了。这也是 DDA 后来被数据采样法取代的主要原因。不过 DDA 的思路没有白费今天伺服驱动器里的位置指令规划仍然能看到“周期累加、按比例输出”的影子。2.3 数据采样法现代 CNC 和运动控制卡的标准插补方式数据采样法的思路是每个插补周期 Ts 内根据进给速度 F在当前点处沿圆弧切线方向走一小段弧长 ΔL F × Ts再把弧长折算成对应的圆心角增量 Δθ ΔL / R用角度累加生成下一个插补点。插补点之间用直线段连接直线段中点并不一定落在圆弧上所以存在弓高误差 h。弓高误差的推导很简单ΔL 对应的弦长近似等于 ΔL圆心到弦中点的距离是 R - h由勾股定理 (R - h)² (ΔL/2)² R²展开后忽略 h² 项就得到工程上常用的近似式 h ≈ ΔL² / (8R)。进给速度越快、圆弧半径越小、插补周期越长h 就越大。用 Fmax sqrt(8Rh) / Ts 可以在给定半径和精度要求下反推允许的最大进给速度。圆弧半径 R(mm)插补周期 Ts(ms)目标弓高误差 h(mm)允许最大进给速度 Fmax(mm/s)2510.0014472510.00510002510.0101414250.50.001894100.50.001400100.50.005894这张表说明两个常被忽略的事实。其一弓高误差通常在微米级并不会让工件出现肉眼可见的多边形真正导致圆度恶化的是机械间隙和伺服跟随误差。其二Ts 缩短后在同样 h 约束下允许的进给速度按反比例提升。高端运动控制卡把插补周期从 2 ms 缩到 0.25 ms主要动机不是“平滑”而是在同样精度目标下把速度上限放宽。2.4 顺圆逆圆、IJK 与 R 写法的坐标系统一数据采样法里的角度累加方向由 G02/G03 决定。按右手坐标系、从 Z 轴正方向看G03 是逆时针、角度增大方向G02 是顺时针、角度减小方向。用 I J K 编程时I、J、K 是圆心相对圆弧起点的增量坐标圆心位置等于起点坐标加 I J K。用 R 编程时R 0 表示圆心角小于 180° 的圆弧R 0 表示大于 180° 的优弧。整圆不能用 R因为起点和终点重合R 无法唯一确定圆心必须用 I J K。实际工程里最容易被忽略的坑是坐标系镜像。如果设备结构原因把某个运动轴的机械方向取反G02/G03 的定义就会跟着反转。常见做法是在上位机里单独做一层机械坐标到逻辑坐标的映射插补算法只认逻辑坐标不让 Y 轴镜像污染方向判断。我在调试双驱龙门和龙门式点胶机时经常遇到客户说“走圆的方向反了”查到最后都是坐标映射层的问题不是插补算法的问题。3. 数据采样圆弧插补的代码骨架与三个关键参数3.1 最小可跑的圆弧插补核心函数用 Python 写一个数据采样圆弧插补的核心函数逻辑可以直接翻译成 C 或 Verilog。import math def arc_interp(p0, pc, direction, sweep, ts, f): 数据采样法圆弧插补 p0: 起点坐标 (x, y) pc: 圆心坐标 (x, y) direction: 1 为逆时针(G03), -1 为顺时针(G02) sweep: 圆心角(弧度), 普通圆弧取值 0 ~ 2*pi ts: 插补周期, 单位 s f: 进给速度, 单位 mm/s 返回: 插补点列表, 包含起点和修正后的终点 xc, yc pc x0, y0 p0 r math.hypot(x0 - xc, y0 - yc) theta0 math.atan2(y0 - yc, x0 - xc) # 起点相对圆心的角度 delta_l f * ts # 单个插补周期走过的弧长 delta_theta delta_l / r # 单个插补周期的转角步距 total_angle direction * sweep # 带方向的圆心角 n max(1, int(math.ceil(abs(total_angle) / delta_theta))) pts [] for i in range(n 1): theta theta0 direction * i * delta_theta pts.append((xc r * math.cos(theta), yc r * math.sin(theta))) # 强制修正终点, 消除取整残差 xe xc r * math.cos(theta0 total_angle) ye yc r * math.sin(theta0 total_angle) pts[-1] (xe, ye) return pts这段代码的使用前提是调用方已经拿到了圆心坐标、方向和圆心角。圆心从 I J K 增量直接加上起点坐标就能得到圆心角需要根据终点反算或直接传入。几个关键点需要解释一下。起点角度用atan2而不是acos或asin是为了避免象限遗漏。atan2天然返回 (-π, π] 范围的角度配合hypot求半径几何计算不会出现象限分支错误。角度更新用theta0 direction * i * delta_theta而不是每次在循环里theta delta_theta。原因是浮点数累加会随循环次数增长而放大误差而用乘法每次从 theta0 重新计算误差不会层层累积。长圆弧上这个区别特别明显。n用ceil向上取整保证最后一个插补点一定落在圆弧终点之外再用终点坐标强制覆盖最后一个点。如果不做这个修正末段弧长和插补步距不匹配时终点会出现一个小于 delta_theta 的残差整圆加工时起点和终点就对不上了。3.2 插补周期、速度前馈、反向间隙三个参数怎么设圆弧插补本身只是几何计算实际加工质量很大程度上取决于插补周期和伺服参数的配合。按现场调试顺序三个参数的重要性和调整策略如下。参数典型范围设置顺序调整参考插补周期 Ts0.25 ms ~ 2 ms第一优先与伺服周期保持整数倍关系取伺服带宽的 1/5 ~ 1/10速度前馈0% ~ 100%第二优先先看位置跟随误差再逐步增加前馈以过象限不振动为上限反向间隙补偿实测值最后用千分表实测正向和反向换向间隙不按丝杠标称值填插补周期不能单纯追求小。运动控制卡通常允许配置 0.25 ms 到 2 ms但每个插补周期都要和伺服驱动器的周期保持整数倍关系否则采样抖动量会直接作用到轨迹上。曾经在一个 0.5 ms 插补周期配 1 ms 伺服周期的项目里整圆表面出现周期性波纹把插补周期改成 1 ms 后波纹消失原因是两个周期不同步引入了低频差拍。速度前馈的作用是补偿位置环的跟随滞后但圆弧过象限时摩擦方向反转前馈把滞后强行压成速度阶跃容易在换向处冲出一个小尖角。所以前馈的调整上限不是“跟随误差最小”而是“过象限不振动”。反向间隙补偿不是算出来的是拿千分表顶在轴上、手动推换向测出来的。注意的是反向间隙有方向性正向换向和反向换向的间隙值可能不同补偿表里要分开填。3.3 整圆与优弧的边界条件实际解析 G 代码时除了插补函数本身还需要处理三个边界条件。整圆场景下起点和终点重合无法用终点反算圆心角。此时sweep直接按方向赋为2 * pi其他逻辑与普通圆弧一致。但要特别注意整圆插补出来的最后一个点会被修正成起点坐标与前一个点之间会出现一个长度为零的线段。上位机如果逐段画线或计算切线方向需要过滤掉重复点。优弧场景下R 编程用负号表示优弧。解析程序需要把 R 符号映射成圆心角先计算起点向量和终点向量之间的短夹角再用atan2(cross, dot)得到带方向的短夹角最后根据短夹角是否大于 180° 决定实际 sweep。推荐用atan2(cross, dot)而不是acos(dot / (r1 * r2))因为acos在夹角接近 0 或 π 时数值稳定性差会产生较大角度误差。角度归一化是另一个容易踩的坑。终点反算角度差时如果直接用两个角度相减0° 和 359° 会被算成 359° 而不是 1°。需要在相减后把结果 wrap 到 (-π, π] 区间标准写法是angle (angle pi) % (2 * pi) - pi插补循环里每个点生成时也建议做同样的 wrap防止跨 ±π 边界时出现角度跳变。4. 圆弧插补圆度误差的形态排查与补偿顺序4.1 从圆度报表反推插补与机械的问题圆度评价常用最小二乘圆算法把实测点拟合成一个圆计算每个测量点的径向偏差输出圆度误差值。但圆度报表只告诉你“不圆”不会告诉你问题出在插补、伺服跟随还是机械间隙。我会先把误差形态分成四类来定位。误差形态可能原因排查动作整圆起点与终点不重合插补终点修正失效或螺距补偿方向错误让控制器输出纯插补点坐标核对首尾差值45° 方向椭圆拉长XY 两个轴的增益或带宽不一致分别对两轴做相同正弦扫描对比跟随误差曲线过象限位置出现台阶反向间隙补偿缺失或补偿符号填反机械侧顶千分表手动换向读回差圆弧表面有周期性波纹插补周期与机械固有频率耦合修改插补周期或进给速度观察波纹频率是否等比例变化插补层面只决定“该走哪”实际落点由伺服位置环决定。当 X 轴和 Y 轴的跟随误差相位不一致时一个轴滞后另一个轴圆形轨迹在半径方向就会被拉成椭圆长轴方向与滞后较大的轴呈 45° 关系。这是电气原因导致的圆度问题经常被误判为机床导轨精度差实际调 XY 轴增益就能解决。4.2 反向间隙与过象限冲击的补偿策略过象限是圆弧插补最有特色的误差源。当运动方向从 X/Y 跨到 -X/-Y丝杠间隙方向反转、导轨摩擦方向也反转位置环等于要克服一个方向阶跃力。插补点还在按圆弧轨迹输出末端执行器却停顿了几个毫秒工件表面就出现一个台阶。我一般按三个步骤处理。第一步用千分表分别测每个轴的正向换向间隙和负向换向间隙注意两个值可能不一样。比如 X 轴负向间隙 8 μm、正向间隙 12 μm这种情况下只填一个均值补偿效果在某个方向会过冲。第二步在运动控制器的间隙补偿表里分轴填写先填一个方向的实测值跑四分之一圆弧看看台阶是否变小。第三步来回切换补偿符号验证方向。间隙补偿符号填反时过象限处会从台阶变成一个小鼓包比不补偿更难看。一个重要细节是反向间隙补偿不能加在插补输出的坐标增量上。如果加在坐标上换向时会产生一个阶跃位移圆弧轮廓上反而多出一个尖角。常见做法是把它交给伺服驱动器或运动控制卡的专用反向间隙参数在位置闭环的指令累加侧处理。4.3 误差补偿的优先级插补前、插补中、插补后我把补偿动作按作用位置分成三层排查问题时先确认误差属于哪一层不要一看到圆度变差就去改插补周期。插补前的补偿处理几何层面的误差包括工件坐标系旋转、刀具半径补偿、龙门轴同步误差修正。这些修正完成后圆弧的起点、终点和圆心都已经发生变化插补算法不需要感知补偿的存在。插补中的补偿处理时间层面的误差包括速度前馈、拐角减速、过象限速度限制。这些动作改变的是每个插补周期的弧长和方向不改变圆弧几何参数。对圆弧插补来说过象限前主动降低进给速度能让摩擦换向带来的位置波动明显减小。插补后的补偿处理机械层面的误差包括反向间隙、螺距误差、光栅尺细分误差。这一层由伺服驱动器的补偿表或运动控制卡的底层参数执行与插补算法解耦。理解这三层的价值在于定位问题。弓高误差通常在微米以下而反向间隙和伺服跟随误差动辄是它的数倍看到圆度报表后先排除机械层再调插补参数顺序颠倒会浪费大量调试时间。5. 圆弧插补的现场验收方法与大半径限速公式应用5.1 用百分表和极坐标图把误差看明白现场没有激光干涉仪和球杆仪时可以用一个简单方法做静态圆度评估把表座固定在机床工作台上百分表表头打在圆柱面最高点让机床走整圆每 22.5° 记录一次读数得到 16 个点画在极坐标纸上。如果点分布呈椭圆长轴方向指向增益失配的轴如果某个角度区间出现突变多半是反向间隙如果 16 个点整体绕圆心旋转一个角度则可能是坐标映射或反向间隙方向问题。这个方法测不到动态轮廓误差但足够在大批量工件加工前筛出“机械问题”和“插补参数问题”。5.2 大半径圆弧的弦高限速公式如何落地把弓高误差公式反过来用给定允许的弦高误差 h_max得到允许的最大弧长 ΔL_max sqrt(8Rh_max)再由 F_max ΔL_max / Ts 得到进给速度上限。第 2 章的表直接来自这个公式。大半径圆弧场景下比如汽车覆盖件模具的整圆铣削R 可能达到几百毫米甚至更大弓高误差几乎不构成限制这时真正约束速度的是向心加速度。向心加速度与进给速度的关系是 a F² / R给定设备末端允许的最大法向加速度 a_max速度上限是 F_max sqrt(a_max × R)。落地时需要注意这个 a_max 不是电机样本上写的轴加速度而是执行末端的法向加速度受负载、机械刚度和切削力共同影响。我一般会先按弓高误差限速计算一次再按向心加速度限速计算一次取两者较小值作为进入圆弧前的目标速度。如果控制器支撑速度前馈自动匹配圆弧路径也可以把这两个限速值作为速度规划器的约束输入而不是写死在程序里。5.3 圆弧切出接直线的刀痕消除圆弧终点接直线段时如果直线与圆弧相切速度方向连续但加速度方向在终点处存在阶跃切削力方向的突变会在接口处留下一条细线。处理这个问题的常见做法有两种。第一种是提前减速法。在圆弧结束前的最后一段距离里按线性或 S 曲线把进给速度降下来让加速度突变幅度变小。代价是加工节拍变差对大批量生产不太友好。第二种是速度混合法也就是数控系统里的 G64 连续路径模式。把前一段圆弧的末速度与后一段直线段的初速度不降到零而是在设定的几何误差带内滑过拐角。此时实际轨迹会偏离编程轨迹偏差量由拐角公差参数控制。精加工余量小且均匀时这个偏差通常落在公差范围内接刀痕明显改善。但几何误差带不是越大越好。在窄槽、清根、尖角避让这类对形状敏感的加工中应当关闭速度混合或把误差带收缩到几微米否则“刀痕消失”的代价是轮廓精度被牺牲。本文还有配套的精品资源点击获取
圆弧插补算法原理与误差补偿：从逐点比较到数据采样
简介圆弧插补是数控加工与运动控制中的关键环节决定刀具或执行机构能否按圆弧轨迹平稳运动。这份资源以C语言实现圆弧插补核心代码面向数控系统开发者、嵌入式工程师以及机械电子类专业学生适用于学习插补原理、调试运动控制算法或完成课程设计等场景。压缩包内共包含2个文件以.c源码文件为主另含辅助文件整体体积仅3KB结构紧凑、便于快速定位核心逻辑。已有658人学习了该资源。通过这份源码读者可以拆解圆弧插补的坐标计算、象限判断、步进脉冲输出等典型步骤结合简要注释理解整套算法流程同时精简的代码也适合作为基础模板迁移到自己的控制平台或继续扩展为顺/逆圆插补、多轴联动等功能从而实现从原理到实践的有效跨越。1. 圆弧插补在运动控制里为什么是分水岭数控制造、点胶机、激光切割和直角坐标机器人里直线插补是入门圆弧插补才是分水岭。很多人写运动控制程序时习惯把圆弧切成几百段短直线去逼近加工出来发现内圈和外圈都出现明显的多边形棱边。问题不在于直线段数不够而在于没有理解圆弧插补的本质用误差可控的微线段逼近理想圆弧在每个插补周期里输出坐标增量让轨迹速度保持连续而不是靠“切得足够细”硬扛。下面从圆弧插补的数学模型讲起把逐点比较、DDA 和数据采样三种实现思路讲清楚再给出一段能直接改来用的数据采样圆弧插补代码最后落到参数标定、圆度误差排查和实际加工里的限速与刀痕控制。适合运动控制卡开发、CNC 系统集成、自动化设备软件调试的工程师也适合刚接触插补算法、想搞明白 G02/G03 背后到底在算什么的人。2. 圆弧插补的三种算法路径与精度边界2.1 逐点比较法一个点一个点校正偏差最早的开环数控系统常用逐点比较法典型场景是普车数控改造和步进电机直接驱动的简单控制器。核心思想是每走一步就比较当前坐标点与理想圆弧的相对位置如果点在圆外下一步就朝圆心方向走一步如果点在圆内下一步就朝远离圆心的方向走一步。实际走的轨迹是阶梯状锯齿线每一步只有八个方向可选。偏差判别式是 F x² y² - R²。F 0 表示点在圆上F 0 表示点在圆外F 0 表示点在圆内。插补器根据 F 的符号决定下一步的进给方向。这个算法实现简单脉冲频率直接决定速度但它的分辨率被脉冲当量锁死。比如插补一个半径 20 mm 的 90° 圆弧脉冲当量按 0.001 mm 算总步数大约三万多步每一步都可能产生一个脉冲当量的阶梯误差。逐点比较法能保证误差不超过一个脉冲当量所以对没有位置反馈的步进系统来说它已经是精度下限的保证。但现代伺服系统普遍带编码器闭环再用这种算法就浪费了硬件能力现在新系统几乎不把它作为主插补器只在老式步进控制板里还能见到。2.2 DDA 数字积分法用积分器同时输出两轴增量数字积分法也就是 DDADigital Differential Analyzer把圆弧看作两个坐标方向对时间积分的结果。对圆的参数方程求导X 方向增量与 Y 坐标相关Y 方向增量与 X 坐标相关两者互为交换。用两个数字积分器分别累加就能在每个插补周期输出均匀的坐标增量。DDA 比逐点比较法输出更均匀没有锯齿状阶梯对速度和加速度控制也更友好所以七八十年代的大量数控系统和机器人控制器都建立在 DDA 基础上。但它有一个工程上的别扭之处积分溢出处理和插补速度上限耦合在一起修改进给速度时要同步调整积分系数否则进给速度一提上去积分累加器先溢出了。这也是 DDA 后来被数据采样法取代的主要原因。不过 DDA 的思路没有白费今天伺服驱动器里的位置指令规划仍然能看到“周期累加、按比例输出”的影子。2.3 数据采样法现代 CNC 和运动控制卡的标准插补方式数据采样法的思路是每个插补周期 Ts 内根据进给速度 F在当前点处沿圆弧切线方向走一小段弧长 ΔL F × Ts再把弧长折算成对应的圆心角增量 Δθ ΔL / R用角度累加生成下一个插补点。插补点之间用直线段连接直线段中点并不一定落在圆弧上所以存在弓高误差 h。弓高误差的推导很简单ΔL 对应的弦长近似等于 ΔL圆心到弦中点的距离是 R - h由勾股定理 (R - h)² (ΔL/2)² R²展开后忽略 h² 项就得到工程上常用的近似式 h ≈ ΔL² / (8R)。进给速度越快、圆弧半径越小、插补周期越长h 就越大。用 Fmax sqrt(8Rh) / Ts 可以在给定半径和精度要求下反推允许的最大进给速度。圆弧半径 R(mm)插补周期 Ts(ms)目标弓高误差 h(mm)允许最大进给速度 Fmax(mm/s)2510.0014472510.00510002510.0101414250.50.001894100.50.001400100.50.005894这张表说明两个常被忽略的事实。其一弓高误差通常在微米级并不会让工件出现肉眼可见的多边形真正导致圆度恶化的是机械间隙和伺服跟随误差。其二Ts 缩短后在同样 h 约束下允许的进给速度按反比例提升。高端运动控制卡把插补周期从 2 ms 缩到 0.25 ms主要动机不是“平滑”而是在同样精度目标下把速度上限放宽。2.4 顺圆逆圆、IJK 与 R 写法的坐标系统一数据采样法里的角度累加方向由 G02/G03 决定。按右手坐标系、从 Z 轴正方向看G03 是逆时针、角度增大方向G02 是顺时针、角度减小方向。用 I J K 编程时I、J、K 是圆心相对圆弧起点的增量坐标圆心位置等于起点坐标加 I J K。用 R 编程时R 0 表示圆心角小于 180° 的圆弧R 0 表示大于 180° 的优弧。整圆不能用 R因为起点和终点重合R 无法唯一确定圆心必须用 I J K。实际工程里最容易被忽略的坑是坐标系镜像。如果设备结构原因把某个运动轴的机械方向取反G02/G03 的定义就会跟着反转。常见做法是在上位机里单独做一层机械坐标到逻辑坐标的映射插补算法只认逻辑坐标不让 Y 轴镜像污染方向判断。我在调试双驱龙门和龙门式点胶机时经常遇到客户说“走圆的方向反了”查到最后都是坐标映射层的问题不是插补算法的问题。3. 数据采样圆弧插补的代码骨架与三个关键参数3.1 最小可跑的圆弧插补核心函数用 Python 写一个数据采样圆弧插补的核心函数逻辑可以直接翻译成 C 或 Verilog。import math def arc_interp(p0, pc, direction, sweep, ts, f): 数据采样法圆弧插补 p0: 起点坐标 (x, y) pc: 圆心坐标 (x, y) direction: 1 为逆时针(G03), -1 为顺时针(G02) sweep: 圆心角(弧度), 普通圆弧取值 0 ~ 2*pi ts: 插补周期, 单位 s f: 进给速度, 单位 mm/s 返回: 插补点列表, 包含起点和修正后的终点 xc, yc pc x0, y0 p0 r math.hypot(x0 - xc, y0 - yc) theta0 math.atan2(y0 - yc, x0 - xc) # 起点相对圆心的角度 delta_l f * ts # 单个插补周期走过的弧长 delta_theta delta_l / r # 单个插补周期的转角步距 total_angle direction * sweep # 带方向的圆心角 n max(1, int(math.ceil(abs(total_angle) / delta_theta))) pts [] for i in range(n 1): theta theta0 direction * i * delta_theta pts.append((xc r * math.cos(theta), yc r * math.sin(theta))) # 强制修正终点, 消除取整残差 xe xc r * math.cos(theta0 total_angle) ye yc r * math.sin(theta0 total_angle) pts[-1] (xe, ye) return pts这段代码的使用前提是调用方已经拿到了圆心坐标、方向和圆心角。圆心从 I J K 增量直接加上起点坐标就能得到圆心角需要根据终点反算或直接传入。几个关键点需要解释一下。起点角度用atan2而不是acos或asin是为了避免象限遗漏。atan2天然返回 (-π, π] 范围的角度配合hypot求半径几何计算不会出现象限分支错误。角度更新用theta0 direction * i * delta_theta而不是每次在循环里theta delta_theta。原因是浮点数累加会随循环次数增长而放大误差而用乘法每次从 theta0 重新计算误差不会层层累积。长圆弧上这个区别特别明显。n用ceil向上取整保证最后一个插补点一定落在圆弧终点之外再用终点坐标强制覆盖最后一个点。如果不做这个修正末段弧长和插补步距不匹配时终点会出现一个小于 delta_theta 的残差整圆加工时起点和终点就对不上了。3.2 插补周期、速度前馈、反向间隙三个参数怎么设圆弧插补本身只是几何计算实际加工质量很大程度上取决于插补周期和伺服参数的配合。按现场调试顺序三个参数的重要性和调整策略如下。参数典型范围设置顺序调整参考插补周期 Ts0.25 ms ~ 2 ms第一优先与伺服周期保持整数倍关系取伺服带宽的 1/5 ~ 1/10速度前馈0% ~ 100%第二优先先看位置跟随误差再逐步增加前馈以过象限不振动为上限反向间隙补偿实测值最后用千分表实测正向和反向换向间隙不按丝杠标称值填插补周期不能单纯追求小。运动控制卡通常允许配置 0.25 ms 到 2 ms但每个插补周期都要和伺服驱动器的周期保持整数倍关系否则采样抖动量会直接作用到轨迹上。曾经在一个 0.5 ms 插补周期配 1 ms 伺服周期的项目里整圆表面出现周期性波纹把插补周期改成 1 ms 后波纹消失原因是两个周期不同步引入了低频差拍。速度前馈的作用是补偿位置环的跟随滞后但圆弧过象限时摩擦方向反转前馈把滞后强行压成速度阶跃容易在换向处冲出一个小尖角。所以前馈的调整上限不是“跟随误差最小”而是“过象限不振动”。反向间隙补偿不是算出来的是拿千分表顶在轴上、手动推换向测出来的。注意的是反向间隙有方向性正向换向和反向换向的间隙值可能不同补偿表里要分开填。3.3 整圆与优弧的边界条件实际解析 G 代码时除了插补函数本身还需要处理三个边界条件。整圆场景下起点和终点重合无法用终点反算圆心角。此时sweep直接按方向赋为2 * pi其他逻辑与普通圆弧一致。但要特别注意整圆插补出来的最后一个点会被修正成起点坐标与前一个点之间会出现一个长度为零的线段。上位机如果逐段画线或计算切线方向需要过滤掉重复点。优弧场景下R 编程用负号表示优弧。解析程序需要把 R 符号映射成圆心角先计算起点向量和终点向量之间的短夹角再用atan2(cross, dot)得到带方向的短夹角最后根据短夹角是否大于 180° 决定实际 sweep。推荐用atan2(cross, dot)而不是acos(dot / (r1 * r2))因为acos在夹角接近 0 或 π 时数值稳定性差会产生较大角度误差。角度归一化是另一个容易踩的坑。终点反算角度差时如果直接用两个角度相减0° 和 359° 会被算成 359° 而不是 1°。需要在相减后把结果 wrap 到 (-π, π] 区间标准写法是angle (angle pi) % (2 * pi) - pi插补循环里每个点生成时也建议做同样的 wrap防止跨 ±π 边界时出现角度跳变。4. 圆弧插补圆度误差的形态排查与补偿顺序4.1 从圆度报表反推插补与机械的问题圆度评价常用最小二乘圆算法把实测点拟合成一个圆计算每个测量点的径向偏差输出圆度误差值。但圆度报表只告诉你“不圆”不会告诉你问题出在插补、伺服跟随还是机械间隙。我会先把误差形态分成四类来定位。误差形态可能原因排查动作整圆起点与终点不重合插补终点修正失效或螺距补偿方向错误让控制器输出纯插补点坐标核对首尾差值45° 方向椭圆拉长XY 两个轴的增益或带宽不一致分别对两轴做相同正弦扫描对比跟随误差曲线过象限位置出现台阶反向间隙补偿缺失或补偿符号填反机械侧顶千分表手动换向读回差圆弧表面有周期性波纹插补周期与机械固有频率耦合修改插补周期或进给速度观察波纹频率是否等比例变化插补层面只决定“该走哪”实际落点由伺服位置环决定。当 X 轴和 Y 轴的跟随误差相位不一致时一个轴滞后另一个轴圆形轨迹在半径方向就会被拉成椭圆长轴方向与滞后较大的轴呈 45° 关系。这是电气原因导致的圆度问题经常被误判为机床导轨精度差实际调 XY 轴增益就能解决。4.2 反向间隙与过象限冲击的补偿策略过象限是圆弧插补最有特色的误差源。当运动方向从 X/Y 跨到 -X/-Y丝杠间隙方向反转、导轨摩擦方向也反转位置环等于要克服一个方向阶跃力。插补点还在按圆弧轨迹输出末端执行器却停顿了几个毫秒工件表面就出现一个台阶。我一般按三个步骤处理。第一步用千分表分别测每个轴的正向换向间隙和负向换向间隙注意两个值可能不一样。比如 X 轴负向间隙 8 μm、正向间隙 12 μm这种情况下只填一个均值补偿效果在某个方向会过冲。第二步在运动控制器的间隙补偿表里分轴填写先填一个方向的实测值跑四分之一圆弧看看台阶是否变小。第三步来回切换补偿符号验证方向。间隙补偿符号填反时过象限处会从台阶变成一个小鼓包比不补偿更难看。一个重要细节是反向间隙补偿不能加在插补输出的坐标增量上。如果加在坐标上换向时会产生一个阶跃位移圆弧轮廓上反而多出一个尖角。常见做法是把它交给伺服驱动器或运动控制卡的专用反向间隙参数在位置闭环的指令累加侧处理。4.3 误差补偿的优先级插补前、插补中、插补后我把补偿动作按作用位置分成三层排查问题时先确认误差属于哪一层不要一看到圆度变差就去改插补周期。插补前的补偿处理几何层面的误差包括工件坐标系旋转、刀具半径补偿、龙门轴同步误差修正。这些修正完成后圆弧的起点、终点和圆心都已经发生变化插补算法不需要感知补偿的存在。插补中的补偿处理时间层面的误差包括速度前馈、拐角减速、过象限速度限制。这些动作改变的是每个插补周期的弧长和方向不改变圆弧几何参数。对圆弧插补来说过象限前主动降低进给速度能让摩擦换向带来的位置波动明显减小。插补后的补偿处理机械层面的误差包括反向间隙、螺距误差、光栅尺细分误差。这一层由伺服驱动器的补偿表或运动控制卡的底层参数执行与插补算法解耦。理解这三层的价值在于定位问题。弓高误差通常在微米以下而反向间隙和伺服跟随误差动辄是它的数倍看到圆度报表后先排除机械层再调插补参数顺序颠倒会浪费大量调试时间。5. 圆弧插补的现场验收方法与大半径限速公式应用5.1 用百分表和极坐标图把误差看明白现场没有激光干涉仪和球杆仪时可以用一个简单方法做静态圆度评估把表座固定在机床工作台上百分表表头打在圆柱面最高点让机床走整圆每 22.5° 记录一次读数得到 16 个点画在极坐标纸上。如果点分布呈椭圆长轴方向指向增益失配的轴如果某个角度区间出现突变多半是反向间隙如果 16 个点整体绕圆心旋转一个角度则可能是坐标映射或反向间隙方向问题。这个方法测不到动态轮廓误差但足够在大批量工件加工前筛出“机械问题”和“插补参数问题”。5.2 大半径圆弧的弦高限速公式如何落地把弓高误差公式反过来用给定允许的弦高误差 h_max得到允许的最大弧长 ΔL_max sqrt(8Rh_max)再由 F_max ΔL_max / Ts 得到进给速度上限。第 2 章的表直接来自这个公式。大半径圆弧场景下比如汽车覆盖件模具的整圆铣削R 可能达到几百毫米甚至更大弓高误差几乎不构成限制这时真正约束速度的是向心加速度。向心加速度与进给速度的关系是 a F² / R给定设备末端允许的最大法向加速度 a_max速度上限是 F_max sqrt(a_max × R)。落地时需要注意这个 a_max 不是电机样本上写的轴加速度而是执行末端的法向加速度受负载、机械刚度和切削力共同影响。我一般会先按弓高误差限速计算一次再按向心加速度限速计算一次取两者较小值作为进入圆弧前的目标速度。如果控制器支撑速度前馈自动匹配圆弧路径也可以把这两个限速值作为速度规划器的约束输入而不是写死在程序里。5.3 圆弧切出接直线的刀痕消除圆弧终点接直线段时如果直线与圆弧相切速度方向连续但加速度方向在终点处存在阶跃切削力方向的突变会在接口处留下一条细线。处理这个问题的常见做法有两种。第一种是提前减速法。在圆弧结束前的最后一段距离里按线性或 S 曲线把进给速度降下来让加速度突变幅度变小。代价是加工节拍变差对大批量生产不太友好。第二种是速度混合法也就是数控系统里的 G64 连续路径模式。把前一段圆弧的末速度与后一段直线段的初速度不降到零而是在设定的几何误差带内滑过拐角。此时实际轨迹会偏离编程轨迹偏差量由拐角公差参数控制。精加工余量小且均匀时这个偏差通常落在公差范围内接刀痕明显改善。但几何误差带不是越大越好。在窄槽、清根、尖角避让这类对形状敏感的加工中应当关闭速度混合或把误差带收缩到几微米否则“刀痕消失”的代价是轮廓精度被牺牲。本文还有配套的精品资源点击获取
