1. 从几何学理解拐点速度的核心问题
想象一下你正在驾驶一辆赛车,赛道由多条直线段组成。当从一个直线段转向另一个直线段时,如果直接急转弯,要么会冲出赛道,要么必须将车速降到几乎为零才能安全通过。这就是CNC机床在加工路径拐角时面临的真实困境——拐点速度控制。
在grbl源码中,max_junction_speed_sqr这个变量就是解决这个问题的关键。它通过构造一个虚拟的内切圆模型,计算出当前运动方向与下一段运动方向之间的最大允许过渡速度。这个速度要满足两个基本条件:
- 不能超过各轴电机的加速度极限
- 要保证路径精度符合
junction_deviation参数设定的误差范围
具体到几何学上,当两个运动向量V_entry和V_exit形成夹角θ时,grbl会计算它们的单位向量点积(junction_cos_theta)。这个值在代码中通过简单的循环就能得到:
c复制float junction_cos_theta = 0.0;
for (idx=0; idx<N_AXIS; idx++) {
junction_cos_theta -= pl.previous_unit_vec[idx]*unit_vec[idx];
}
这个点积值实际上就是cosθ,它决定了拐角的"尖锐程度"。当cosθ接近1时(θ接近0°),说明两段路径几乎是直线延伸;当cosθ接近-1时(θ接近180°),意味着需要急转弯。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 内切圆模型的数学推导过程
在论文《嵌入式数控系统速度前瞻规划算法研究》中提到的内切圆模型,正是grbl实现拐点速度计算的理论基础。这个模型的精妙之处在于,它将复杂的多轴运动学问题简化为一个经典的圆周运动问题。
假设当前运动方向向量为V_entry,下一段运动方向向量为V_exit,我们可以构造一个与这两个向量都相切的圆。根据圆周运动公式:
code复制v² = a × r
其中:
- v是切向速度(即我们要求的拐点速度)
- a是向心加速度
- r是转弯半径
在grbl源码中,这个公式被拆解为几个关键步骤来实现。首先是计算两向量的夹角半角正弦值:
c复制float sin_theta_d2 = sqrt(0.5*(1.0-junction_cos_theta));
这个值来自
