1. 中断里那几十个周期,往往是功能库选错买来的
DSP28335 有硬件浮点单元,于是很多人在写电流环、速度环时直接把 sinf、sqrtf 往里塞,编译能过、板子能跑,就以为浮点运算库这一层已经搞定了。真实情况是:同样一次三角运算,落在标准 RTS 上要数百个周期,落在 FastRTS 近似库上只要几十个,落在编译器内联的加减乘上是个位数——三个数量级的差距全藏在中断里,控制频率一提上来、几路环路叠在一起跑,周期预算就当场翻车。功能库这一层没有标准答案,只有「这条路径的每一拍值不值得花这些周期」这一笔账。这篇就把账算清:三条路线的对照、怎么接进工程,以及上线之后最容易踩的五个坑。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 功能库三路线对照:从个位数到上千周期,钱花在哪一层
先把账本摊开。同一个三角函数,在 DSP28335 上有三种花法,周期量级差得离谱,而很多人只知道自己调了 sinf,并不知道链接进来的到底是哪一个实现。
| 实现路径 | 典型周期量级 | 精度 | 输入范围 | 建议用在哪 |
|---|---|---|---|---|
| 编译器内联的加减乘、比较、int↔float | 个位数 | IEEE 单精度 | 全范围 | 一切实时路径 |
relaxed 模式下的 / 与 sqrtf |
十几到二十几 | 相对误差 1e-6 量级 | 全范围,极大值附近变差 | 环路里的归一化、幅值计算 |
FastRTS 的 sinf/cosf/atan2f |
几十 | 绝对误差 1e-6~1e-5 量级 | 窄,要求角度已归一化 | 每次中断的三角函数 |
标准 RTS 的 sinf/cosf |
数百 | 高 | 全范围 | 标定、通信、非实时 |
| 任何 double 运算 | 数百到上千 | 高 | 全范围 | 能不用就不用 |
先说一句最容易吃亏的话:表里是量级,不是规格书。同一份代码在 flash 里跑和在 SARAM 里跑,差距能到一倍。所以这张表只能用来定「选哪一层」,具体数字必须在自己板子上量——第五章给了一个不用专业仪器的测法。
2.1 硬件指令那一层:最划算,也最容易被越用越远
第一层是编译器直接内联的加减乘、比较和 int↔float 转换,周期是个位数,精度就是 IEEE 单精度,全范围都安全。这一层没什么可犹豫的,实时路径里能用就全用。麻烦在于很多人从这一层「滑出去」而不自知:一句 a / b 写进去,看着像普通运算,实际调用的是浮点除法例程;一句 sqrtf(x),背后是一次库函数调用。除法在 relaxed 模式下要十几到二十几个周期,比乘法贵一个量级,却常常被当成乘法来用。
所以第一件事不是改三角函数,而是看你的环路上有多少除法。归一化、标幺化、幅值计算,这些每拍都跑的地方,优先考虑把除法改写成乘以倒数常量,把 sqrtf 换成 relaxed 模式下的快速实现。这属于「同一层内换写法」,收益比后面换库直接得多。
c复制// 电流环里的归一化与幅值:这两步每拍都跑
float norm = alpha / beta; // relaxed 模式下走快速的除法实现,十几到二十几周期
float mag = sqrtf(vq * vq + vd * vd); // relaxed 模式下的 sqrtf,相对误差 1e-6 量级
逻辑上,norm 的分母来自采样通道,工程上必须加下限保护,否则分母贴近 0 时相对误差会被放大,算出来的标幺值会跳;mag 的入参是两路电压的平方和,先确认 vq、vd 的幅值没有跑到会触发「极大值附近变差」的区间,再决定要不要给平方和加一个上限钳位。参数上,alpha、beta、vq、vd 一律用 float,不要有任何一处隐式抬到 double——这一点第四章还会单独讲。
2.2 标准 RTS 与 FastRTS 的分工:一个保正确,一个保速度
第二层是标准 RTS,全范围、高精度、数百周期;第三层是 FastRTS 近似库,几十周期、绝对误差 1e-6~1e-5 量级、输入范围窄,要求角度已经归一化。这两个库不是替代关系,是分工关系:一个保正确,一个保速度。
分工的判断标准很简单——看这条路径跑不跑在中断里、跑多快。每次中断都要算的电角度三角函数,放 FastRTS;标定、通信、参数辨识、故障录波这些非实时路径,留标准 RTS,不需要为几十个周期去牺牲全范围能力。我见过一些工程反过来做:中断里图省事没换库,标定流程里为了「统一」全换成近似实现,结果标定出来的增益有千分之几的偏差,回头查了一周才发现问题出在工具链上。
要在中断里用近似库,绕不开的前置动作是角度归一化。FastRTS 的三角函数只在一个窄区间内可信,电角度积分出来是单调增长的,跑到几千度的时候直接喂进去,输出就不是你预期的那个波形。
c复制#include <math.h>
#define PI_F 3.14159265f
/* 中断里只跑窄区间三角函数:调用前必须先把角度折回 [-pi, pi] */
static inline float wrap_pi(float th)
{
while (th > PI_F) th -= 2.0f * PI_F; /* 注意 2.0f,写成 2.0 会把整条算式抬成 double */
while (th < -PI_F) th += 2.0f * PI_F;
return th;
}
float th = wrap_pi(theta_elec); /* theta_elec 是积分出来的电角度 */
float s = sinf(th); /* 链接到 FastRTS 后命中近似实现,几十周期 */
float c = cosf(th);
这段代码的关键不在 sinf 本身,而在 wrap_pi:用减法循环把角度折回主值区间,保证送进近似库的入参永远在它的可信范围内。两个 while 的代价是几个比较和减法,个位数周期,比省下来的几百周期便宜太多。2.0f * PI_F 的 f 后缀不是形式主义,去掉它整条表达式会被隐式提升成 double,前面省下的周期在这里一次性还回去。归一化之后,绝对误差 1e-6~1e-5 量级对控制量来说通常够用——采样通道本身的噪声和量化往往比这个大——但如果这个角度还会进长积分、或者参与多拍累加,误差会滚,这种地方就别用近似实现。
2.3 自建查表的边界:什么时候才值得自己动手
第三条路是自己建表加插值。它不在上面的对照表里,因为它不是一个「库」,而是一套你自己维护的实现:输入范围由你定、精度由你定、表放在哪也由你定。这条路的收益上限不高,成本却不低,我一般只在两种情况下考虑:一是某个函数被调用得极其频繁,而且入参范围在工程上可以被死死约束住;二是近似库的表和你的精度预算对不上,你需要自己控制误差形状。
代价要提前算清。表要占 RAM 或 flash,放 RAM 就得从别的 buffer 里挤;插值多一个分支和一次乘法,分支在流水线里的代价不像看上去那么便宜;最麻烦的是维护——你手上多了一套和芯片无关、只和你自己代码有关的误差特性,换平台、换编译器、换优化等级,都得重新验证一遍。所以我的默认答案是:先把 2.1 和 2.2 两层用尽,确实还有余量压力,再考虑查表,而不是一上来就自己造。
提示:三条路线不是互斥的。一个工程里同时存在标准 RTS 和 FastRTS 是常态,关键是每一处调用你都说得出「为什么是这一层」。
3. 把功能库接进工程:编译选项、段放置、调用替换
选型定完,接下来是三处实打实的改造:编译选项决定 / 和 sqrtf 走哪套实现,段放置决定函数在 flash 还是 SARAM 里取指,调用替换决定中断里那几句三角函数最终链接到哪个库。这三处任何一处没落到位,前面的选型都只是纸面结论。
3.1 编译选项:relaxed 模式打开之后换掉了什么
relaxed 模式的本质是松绑 IEEE 严格语义:允许编译器用更快但不严格符合舍入要求的算法去实现除法与开方。打开它,/ 和 sqrtf 从「全范围、慢」变成「十几到二十几周期、相对误差 1e-6 量级、极大值附近变差」。这个交换在实时环路里通常是值的,但它是全工程生效的开关,一旦打开,所有非实时路径也跟着放松了精度。
我的做法是把近似调用收进一层薄封装,单独放在一个编译单元里,这样替换、回退、单独控制编译选项都只改一处;如果工具链不支持按文件设置浮点模式,只能全局开,那就更要保证标定、通信这些路径不依赖严格舍入的结果。
c复制/* fast_math_port.c:近似调用集中在这一层,便于单独控制编译选项与整体回退 */
#include <math.h>
float fm_sin(float theta) { return sinf(theta); } /* 输入约定:已归一化到 [-pi, pi] */
float fm_cos(float theta) { return cosf(theta); } /* 同上 */
float fm_atan2(float y, float x) { return atan2f(y, x); }
逻辑上,这一层封装把「精度契约」写在了函数名和注释里:调用者必须自己保证入参已归一化,封装层不做检查,因为检查也要花周期。参数上,所有入参出参都是 float,没有一处 double;返回值的绝对误差量级是 1e-6~1e-5,使用方要按这个量级去定后续的滤波和判断阈值,而不是按标准 RTS 的精度去定。
打开 relaxed 之后,还要养成一个习惯:拿到任何一个浮点结果,先问一句「这个值会不会跑到极大值附近」。会,就在调用前做范围钳位,或者在这个特定位置保留标准实现。放松模式带来的误差不是均匀分布的,它在输入两端更难看,这跟「精度低了但处处均匀」是两回事。
3.2 段放置:同一份代码在 flash 和 SARAM 里差一倍的现实
这一条特别容易被忽略:函数放在哪,比它内部怎么算还影响周期。同一份代码在 flash 里跑和在 SARAM 里跑,差距能到一倍。中断服务函数和它调用的三角函数封装如果都待在 flash 里,取指带宽和等待周期会把你辛苦省下来的周期再吃掉一大块。
做法是给热点函数单独指定段,再在链接配置里把这个段放到 SARAM。这一步不需要改算法,只加一行 pragma、改一处链接文件。
c复制/* 把中断服务函数整体放进 SARAM 段,减少 flash 取指开销 */
#pragma CODE_SECTION(foc_isr, ".saram_code")
interrupt void foc_isr(void)
{
/* 控制循环主体:读采样、算环路、出 PWM */
}
逻辑说明:CODE_SECTION 只改变函数的存放位置,不改它的行为;函数内部的近似调用仍然按 3.1 和 3.3 的约定走。参数说明:.saram_code 是自定义段名,必须在链接配置里给它分配一段 SARAM 的地址区间,否则链接阶段会报段未定位;SARAM 容量有限,优先放中断服务函数和它直接调用的那几个封装,不要把整个工程往里塞;纯代码段不参与初始化拷贝,放进去之后不需要额外的启动搬运,这一点比放初始化数据省心。
放好之后,验证方法很朴素:看链接生成的映射文件,确认 .saram_code 确实落在 SARAM 地址区间里、并且没有被别的大 buffer 挤掉。映射文件里没出现你的函数名,说明 pragma 没生效或者被优化掉了,这时候测出来的周期数不能信。
3.3 调用替换:把 sinf 换到 FastRTS 的最小改动
第三处改造最容易出事,因为它涉及「同名函数到底链接到了谁」。目标是让中断里的三角运算命中近似实现,同时不动 FOC 核心算法文件——核心算法保持不变,只改底层接口,这样后续更新或者回退调试都方便,把整套算法重写一遍再调,代价大得多。
c复制/* 改动前:中断里直接调标准实现,数百周期 */
theta = theta_elec;
s = sinf(theta);
c = cosf(theta);
/* 改动后:先归一化,再走统一的封装入口 */
theta = wrap_pi(theta_elec); /* 折回 [-pi, pi],满足近似库的输入范围要求 */
s = fm_sin(theta); /* 命中 FastRTS,几十周期 */
c = fm_cos(theta);
逻辑说明:改动的边界严格限制在「调用点 + 一层封装」,算法文件里的公式、环路结构、参数一律不动。参数说明:theta_elec 是积分得到的电角度,可能到几千度,必须先 wrap_pi;fm_sin/fm_cos 的入参契约是已归一化,封装层不做二次检查;替换后要立刻看映射文件,确认近似库真的被链接进来、并且没有因为符号解析顺序又把标准实现拉回来——这一步没确认,你测到的可能还是原来那几百周期。
还有一条纪律:替换要一次性替换干净,别一半调用走封装、一半还直连 sinf。混着用的后果是周期数看起来「有点改善但没到位」,排查时你会怀疑库没生效,实际上是漏改了几处。改完拿全文搜索过一遍 sinf、cosf、atan2f、sqrtf,把每一处的归属都写清楚。
4. 避坑与排查:功能库上线后的五类翻车
4.1 现象:中断周期被吃掉一半,映射文件里还是标准 RTS
现象很典型:明明加了近似库、也改了调用,示波器上中断的高电平宽度却没怎么缩,控制频率还是提不上去。原因八成是符号解析没按预期走——链接顺序、库的搜索路径、或者某处还残留一个直连的 sinf,把标准实现又拉了回来;也可能是近似库根本没进链接。解决办法是先把「谁被链接进来了」这件事变成可查的:打开映射文件,搜函数名,看它落在哪个库、哪个段;再全文搜一遍三角函数调用,把漏改的点补上;最后重新测一次中断宽度,确认改动前后有可分辨的差异。这一步不做,后面所有调优都是在猜。
4.2 现象:波形偶发畸变,只在某些电角度出现
现象是输出波形大体正常,但在特定角度附近偶发畸变,换个转速又消失,很玄学。原因通常是把未归一化的角度直接喂给了近似库:电角度积分到几千度时超出了它的可信区间,输出偏离预期。解决是在调用前强制归一化到 [-pi, pi],并把这个约定写进封装层的注释和接口名;调试期可以在归一化函数里加一个越界计数,一旦计数非零就说明有调用点绕过了约定。别指望在输出端靠滤波掩盖,畸变的来源在角度上,滤不掉。
4.3 现象:同一份代码换到另一块板子就变慢
现象是代码一行没改,换块板子或者换个工程配置,中断周期明显变长。原因是函数放置变了——热点函数没在 SARAM 段里,或者段虽然定义了但被别的 buffer 挤到了别处,取指开销翻倍。解决是先看映射文件里段的实际落点,再确认链接配置里的段分配没有被后续改动覆盖;把中断服务函数和它直接调用的封装固定在同一段里,减少跨段取指。这件事的血泪经验是:段放置不能靠记忆,每次改链接配置都要回去看映射文件。
4.4 现象:relaxed 打开后,极大值附近的结果跳变
现象是大部分工况正常,唯独输入接近两端极值时结果跳变,标定流程里尤其明显。原因是 relaxed 模式下的 / 与 sqrtf 在极大值附近误差变差,而这条路径恰好没做范围限制。解决分两种:实时路径里给入参加钳位,把工作区间约束在误差可控的范围内;非实时路径(标定、参数辨识)直接保留标准实现,不为了统一而统一。同一个工程里两种实现并存是正常的,不正常的是你以为它们精度一样。
4.5 现象:double 悄悄混进来,性能直接崩
现象是改完库、放好段,周期还是远超预算,映射文件里能看到双精度浮点例程。原因是算式里混进了 double:字面量写成 2.0 而不是 2.0f、中间变量声明成 double、某个库函数返回双精度,一次隐式提升就把整条表达式拖进数百到上千周期的区间。解决是把实时路径上的所有字面量补 f 后缀、所有中间量声明成 float,改完再扫一遍映射文件确认没有双精度例程残留。这一条最冤枉,因为它跟选型对错无关,纯粹是写法问题。
5. 把量级换成自己板子上的数字:一次 GPIO 翻转就能测
前面所有的周期数字都只是量级,不能拿来当设计余量。真正能写进设计文档的,只有你自己板子上量出来的数。不需要专业仪器,一个空闲 GPIO 加一台逻辑分析仪(或者带存储的示波器)就够:被测段前后各翻转一次电平,中间跑 N 次,量出高电平宽度再除以 N。
c复制/* 批量测一段三角函数的总耗时:GPIO 翻转标出被测区间 */
#define TEST_N 1000
GpioDataRegs.GPASET.bit.GPIO0 = 1; /* 拉高,标记开始 */
for (i = 0; i < TEST_N; i++) {
y = sinf(x + step); /* 被测调用,走当前链接到的实现 */
x += step; /* 累加避免被优化掉 */
}
GpioDataRegs.GPACLEAR.bit.GPIO0 = 1; /* 拉低,标记结束 */
逻辑说明:用 N 次循环把单次调用的纳秒级耗时放大到逻辑分析仪能分辨的宽度,再除以 N 得到单次量级。参数说明:TEST_N 取到高电平宽度落在采样率舒服的区间即可,太小测不准、太大可能被中断打断;x 的累加和 y 的写出是防止编译器把整个循环优化掉,必要时把 y 声明成 volatile;测的时候要把中断关掉或者固定住其它任务,否则量到的是「中断 + 别的东西」。
测完把结果整理成一张自己的表,跟第二章的量级对照着看,差得离谱就回头查是不是段放错了、库没链上、或者混进了 double。
| 被测项 | 放置位置 | 链接到的实现 | 单次实测 | 与量级是否吻合 |
|---|---|---|---|---|
sinf |
flash | 标准 RTS | 自行填写 | 数百周期量级 |
sinf |
SARAM | FastRTS | 自行填写 | 几十周期量级 |
sqrtf |
flash | relaxed | 自行填写 | 十几到二十几周期 |
a / b |
flash | 软件除法 | 自行填写 | 十几到二十几周期 |
这张表的价值不在数字本身,而在于它把「我以为」变成了「我量过」。从那以后我每次动浮点运算库,都强制走一遍同样的顺序:先看映射文件确认链接到的是哪个实现,再确认段落在 SARAM 还是 flash,最后用 GPIO 翻转量一遍单次周期,三个都对上才允许进下一轮调参。少走一步,后面就得花几倍时间在中断里找那几十个周期到底丢在哪。希望帮到你。
