本文导读
- 一、自动门控制算法概述
- 二、PID控制算法详解与参数整定
- 三、FOC磁场定向控制原理
- 四、SVPWM空间矢量脉宽调制技术
- 五、S型加减速曲线生成算法
- 六、位置控制与轨迹规划
- 七、电流检测与防夹控制算法
- 八、德恩科控制算法研发与应用
- 九、常见技术问题解答
一、自动门控制算法概述
自动门的使用体验好不好，很大程度上取决于控制算法。好的控制算法，开关门平稳柔顺、响应迅速、防夹灵敏、噪音低；不好的控制算法，开关门粗暴、有冲击、噪音大、防夹迟钝。
1.1 控制算法的层次结构
自动门的控制系统是一个多层级的结构，从内到外（从快到慢）通常分为三层：
┌─────────────────────────────────────┐ │ 位置环（外环，最慢） │ ← 控制门的位置，让门准确停在目标位置 ├─────────────────────────────────────┤ │ 速度环（中环） │ ← 控制门的速度，跟踪速度曲线 ├─────────────────────────────────────┤ │ 电流环（内环，最快） │ ← 控制电机电流，快速响应力矩指令 └─────────────────────────────────────┘
电流环：最内层，响应最快（带宽最高），控制电机的相电流，使电流快速、准确地跟踪电流指令。电流环的周期通常是几十微秒到几百微秒。
速度环：中间层，控制电机的转速，使实际速度跟踪设定的速度曲线。速度环的周期通常是几毫秒。
位置环：最外层，控制门的位置，使门准确地停在目标位置（全开、全关、中间某个位置）。位置环的周期通常是几毫秒到十几毫秒。
三环嵌套，外环的输出作为内环的给定，层层递进，共同完成精确的运动控制。
1.2 控制算法的发展历程
| 阶段 | 控制方式 | 特点 | 控制效果 |
| 第一代 | 继电器控制+简单调速 | 只有通断，没有闭环 | 体验差，冲击大，不平稳 |
| 第二代 | 模拟控制+简单PID | 模拟电路实现，参数调整困难 | 有所改善，但性能一般 |
| 第三代 | 单片机+数字PID+六步换向 | 全数字控制，参数可调 | 较好，基本满足使用需求 |
| 第四代 | DSP/ARM+FOC矢量控制+高级算法 | 高性能处理器，复杂算法 | 优秀，运行平稳，响应快，噪音低 |
德恩科磁悬浮自动门采用的就是第四代控制方案——高性能ARM Cortex-M4处理器 + FOC矢量控制 + SVPWM + 三环PID + S型加减速 + 电流检测防夹，控制性能优异。
二、PID控制算法详解与参数整定
PID是工业控制中应用最广泛的控制算法，自动门控制也不例外。电流环、速度环、位置环都可以用PID来控制。
2.1 PID基本原理
PID是比例（Proportional）、积分（Integral）、微分（Derivative）的缩写。
PID输出公式：
u(t) = Kp × e(t) + Ki × ∫e(t)dt + Kd × de(t)/dt
其中：
- u(t)：控制器输出
- e(t)：偏差 = 设定值 - 实际值
- Kp：比例系数
- Ki：积分系数
- Kd：微分系数
比例项（P）：和偏差成正比，偏差越大，控制力度越大。P项是最基本、最直接的调节作用，响应最快。但只有P项会有静差（稳态误差），因为偏差为零时输出也为零，无法维持。
积分项（I）：和偏差随时间的积累成正比。只要有偏差，积分就会不断增加，输出也不断增加，直到偏差为零。I项的作用是消除静差，提高稳态精度。但I项有滞后性，太强会导致超调和振荡。
微分项（D）：和偏差的变化率成正比。偏差变化越快，D项越大。D项的作用是"预判"偏差的变化趋势，提前制动，抑制超调和振荡，提高系统的稳定性和响应速度。
形象的比喻：
- P像弹簧：偏差越大，拉力越大
- I像记忆：记得过去的偏差，慢慢把残余偏差消除
- D像阻尼：变化越快，阻力越大，防止冲过头
2.2 PID参数对系统性能的影响
| 参数 | 增大 | 减小 |
| 比例系数Kp | 响应变快，稳态误差减小；但超调增大，振荡加剧，稳定性下降 | 响应变慢，稳态误差增大；但超调小，稳定性好 |
| 积分系数Ki | 消除静差更快；但超调增大，振荡加剧，稳定性下降 | 消除静差变慢；但超调小，稳定性好 |
| 微分系数Kd | 超调减小，响应变快，稳定性提高；但抗干扰能力下降，对噪声敏感 | 超调增大，响应变慢；但抗干扰能力强 |
可以看出，三个参数之间是相互影响、相互制约的。PID参数整定的目标就是找到一组合适的参数，在响应速度、稳定性、超调量、稳态精度之间取得最佳平衡。
2.3 PID参数整定方法
PID参数怎么调？这是很多工程师头疼的问题。常见的整定方法有：
1. 试凑法（经验法）
最简单也最常用的方法——先给一组初始参数，然后根据系统响应逐步调整，直到满意为止。
一般步骤：
- 先只加P，从小到大调整Kp，直到系统出现等幅振荡
- 然后加入I，从小到大调整Ki，直到静差消除但超调不大
- 最后加入D，从小到大调整Kd，改善动态性能
- 反复微调三个参数，直到满意
口诀："先比例，后积分，最后再加微分；参数整定找最佳，从小到大顺序查。"
2. Ziegler-Nichols法（临界比例度法）
一种经典的工程整定方法，有明确的步骤和公式：
- 先设Ki=0、Kd=0，只保留P项
- 从小到大增加Kp，直到系统出现持续等幅振荡
- 记录此时的临界增益Kcr和临界周期Tcr
- 然后按公式计算PID参数：
P控制：Kp = 0.5×Kcr
PI控制：Kp = 0.45×Kcr，Ti = 0.85×Tcr
PID控制：Kp = 0.6×Kcr，Ti = 0.5×Tcr，Td = 0.125×Tcr
这种方法简单快捷，有理论依据，但不是所有系统都适用，得到的参数通常偏激进（超调较大），需要根据实际情况微调。
3. 衰减曲线法
和临界比例度法类似，但不是等到等幅振荡，而是调到4:1衰减（超调量约25%），然后根据此时的参数和周期计算PID参数。
4. 模型辨识法
先通过实验辨识出被控对象的数学模型（传递函数），然后根据模型用理论方法（比如极点配置、LQR等）设计PID参数。这种方法最准确，但需要系统辨识的能力，比较复杂。
5. 自整定法
高级的控制器自带PID自整定功能，控制器自动给系统加一个测试信号，根据响应自动计算PID参数。方便快捷，适合不熟悉PID整定的用户。
2.4 自动门PID整定的经验
对于自动门控制系统，PID整定有一些经验可以参考：
电流环：
电流环是内环，要求响应快、超调小。一般用PI控制（不加D，因为电流信号噪声大，D项会放大噪声）。电流环的带宽要高，确保电流快速跟踪指令。
速度环：
速度环是中环，要求速度平稳、响应适中。一般用PI或PID控制。速度环的带宽比电流环低，通常是电流环的1/5-1/10。
位置环：
位置环是外环，要求定位准确、运行平稳。一般用P控制或PD控制（位置环积分容易导致超调和振荡，很多系统不加I项，靠速度环的I来消除静差）。
整定顺序：从内到外，先调电流环，再调速度环，最后调位置环。内环调好后再调外环，这样更稳定，也更容易调好。
2.5 数字PID的实现
实际的单片机/DSP控制都是数字控制，PID也是数字PID，不是连续的模拟PID。
数字PID有几种常见的形式：
位置式PID：
u(k) = Kp×e(k) + Ki×Σe(i) + Kd×[e(k)-e(k-1)]
输出的是控制量的绝对值（位置）。优点是直观，缺点是积分项是累加，容易积分饱和，而且计算全量输出，计算量大。
增量式PID：
Δu(k) = Kp×[e(k)-e(k-1)] + Ki×e(k) + Kd×[e(k)-2e(k-1)+e(k-2)]
输出的是控制量的增量（变化量），本次输出 = 上次输出 + 增量。优点是计算量小，不容易积分饱和，手动/自动切换冲击小，适合步进控制。缺点是需要记忆历史输出，积分效果弱一些。
自动门控制中，速度环和电流环常用增量式PID，位置环常用位置式PID。
2.6 PID的改进算法
标准PID在某些情况下效果不够好，于是有了各种改进算法：
1. 积分分离PID
当偏差较大时，暂时取消积分作用，防止积分饱和导致超调过大；当偏差较小到一定范围时，再投入积分作用，消除静差。适合大偏差时不希望积分作用太强的场合。
2. 抗积分饱和PID
当输出达到饱和（上限或下限）时，停止积分累积，防止积分项越积越大，导致退出饱和慢、超调大。
3. 变速积分PID
积分项的系数不是固定的，而是随偏差大小变化——偏差大时积分弱，偏差小时积分强。这样既可以减小超调，又能保证稳态精度。
4. 带死区的PID
当偏差在死区范围内时，认为偏差为零，不进行调节。可以避免频繁调节，减少执行机构的磨损和振荡。适合对稳态精度要求不是特别高，但希望稳定的场合。
5. 微分先行PID
只对测量值（实际值）微分，不对设定值微分。这样可以避免设定值突变时，微分项产生很大的冲击，改善设定值变化时的动态响应。
德恩科的控制算法中，根据不同环的特点，采用了不同的PID改进算法，确保控制性能最优。
三、FOC磁场定向控制原理
FOC（Field Oriented Control，磁场定向控制，也叫矢量控制）是目前高性能电机控制的主流算法。传统的六步换向控制简单，但扭矩脉动大、噪音大、效率低。FOC控制可以实现平稳、高效、精确的电机控制。
3.1 为什么需要FOC？
我们先看看直流电机为什么好控制：
直流电机的定子磁场和转子磁场是垂直的（正交），而且通过换向器保持垂直。所以只要控制电枢电流的大小，就可以线性地控制转矩——电流越大，转矩越大，成正比关系。控制很简单，性能也很好。
但交流电机（永磁同步电机、异步电机）就不一样了：定子是三相绕组，转子是永磁体（或鼠笼），磁场是旋转的。定子电流和转矩之间不是简单的线性关系，直接控制三相电流很难获得好的控制性能。
那能不能把交流电机"变"成直流电机来控制呢？——这就是FOC的基本思想！
FOC通过坐标变换，把交流电机的三相定子电流变换到旋转的dq坐标系下（d轴和转子磁场方向一致，q轴和转子磁场垂直），这样就和直流电机类似了：
- d轴电流（Id）控制励磁（磁通）
- q轴电流（Iq）控制转矩
- 两者解耦，可以独立控制
就像直流电机的励磁电流和电枢电流分开控制一样。这样交流电机的控制就变得和直流电机一样简单、精确了。
3.2 FOC的基本结构
FOC控制系统的结构如下：
Iq_ref →+───► q轴PID ──► Vq ──┐
│ ├─► 反Park变换 ──► Vα,Vβ ──► SVPWM ──► 三相逆变器 ──► 电机
Id_ref →+───► d轴PID ──► Vd ──┘ │
▲ │
│ ┌───────────┐ │
└──────────────────────────┤ Park变换 ◄── Ia,Ib,Ic ◄─── 电流采样
θe └───────────┘
▲
│
位置/速度
传感器
主要步骤：
1. 电流采样：采样电机的三相电流（Ia, Ib, Ic）。一般采两相就够了，因为Ia+Ib+Ic=0，第三相可以算出来。
2. Clark变换（3相→2相静止）：把三相静止坐标系（abc）下的电流变换到两相静止坐标系（αβ）下。
Iα = Ia
Iβ = (Ia + 2Ib)/√3
3. Park变换（2相静止→2相旋转）：把两相静止坐标系（αβ）下的电流变换到两相旋转坐标系（dq）下。dq坐标系和转子磁场同步旋转，d轴和转子磁通方向一致。
Id = Iα×cosθ + Iβ×sinθ
Iq = -Iα×sinθ + Iβ×cosθ
其中θ是转子电角度。
4. PID控制：分别对d轴电流和q轴电流进行PID控制，输出d轴和q轴的电压指令（Vd_ref, Vq_ref）。
- 对于永磁同步电机，通常Id_ref设为0（最大转矩电流比控制），这样所有电流都用来产生转矩，效率最高
- Iq_ref由速度环或位置环给出
5. 反Park变换（2相旋转→2相静止）：把dq坐标系下的电压指令变换回αβ静止坐标系。
Vα = Vd×cosθ - Vq×sinθ
Vβ = Vd×sinθ + Vq×cosθ
6. SVPWM（空间矢量脉宽调制）：根据Vα和Vβ，计算三相逆变器的开关时序，生成PWM波形，驱动电机运转。
7. 位置/速度检测：通过编码器、霍尔传感器等检测转子的位置和速度，用于Park变换和速度环。
这样就构成了一个完整的FOC控制系统。整个过程虽然看起来复杂，但都是基本的数学运算，用现代的MCU/DSP可以轻松实现，计算周期可以做到几十微秒。
3.3 FOC的优点
相比传统的方波控制（六步换向），FOC有以下优势：
| 对比项 | 方波控制（六步换向） | FOC矢量控制 |
| 转矩脉动 | 大，有明显的转矩波动 | 小，转矩平稳 |
| 运行噪音 | 较大 | 很小，几乎静音 |
| 效率 | 一般 | 高（电流波形正弦，铜损小） |
| 低速性能 | 差，低速有抖动 | 好，低速平稳 |
| 调速范围 | 较窄 | 宽（1:1000以上） |
| 控制精度 | 一般 | 高 |
| 动态响应 | 一般 | 快 |
| 算法复杂度 | 简单 | 复杂 |
| 对处理器要求 | 低（8位单片机即可） | 高（需要32位MCU/DSP） |
可以看出，除了算法复杂、对处理器要求高以外，FOC在各个方面都优于传统方波控制。随着MCU性能提升和成本下降，FOC已经从高端应用逐步普及，成为高性能电机控制的标配。
德恩科磁悬浮自动门采用FOC矢量控制技术，电机运行平稳、噪音低、效率高、动态响应快，开关门体验非常好。
四、SVPWM空间矢量脉宽调制技术
SVPWM（Space Vector PWM，空间矢量脉宽调制）是FOC系统中的重要组成部分，负责把αβ坐标系下的电压矢量转换成三相逆变器的PWM开关信号。
4.1 三相逆变器的基本结构
三相电压型逆变器有六个功率管（上桥臂三个，下桥臂三个），分别驱动电机的三相绕组。
┌─────── DC+ ───────┐
│ │ │ │ │
Q1 Q3 Q5 │
│ │ │ │
├────┼────┤ ├─► A相
│ │ │ ├─► B相
Q4 Q6 Q2 └─► C相
│ │ │
└────┴────┴─────── DC-
每个桥臂有两个状态：上管导通（记为1）或下管导通（记为0）。三个桥臂共有2³=8种组合状态，对应8个基本电压矢量：
- U0 (000)：下三管全通，零矢量
- U1 (001)：C相上管通，A、B相下管通
- U2 (010)：B相上管通，A、C相下管通
- U3 (011)：B、C相上管通，A相下管通
- U4 (100)：A相上管通，B、C相下管通
- U5 (101)：A、C相上管通，B相下管通
- U6 (110)：A、B相上管通，C相下管通
- U7 (111)：上三管全通，零矢量
其中U0和U7是零矢量（输出电压为零），U1-U6是六个有效矢量，均匀分布在空间中，每个相差60°电角度。
4.2 SVPWM的基本思想
我们想要的输出电压是一个旋转的电压矢量（大小和角度都随时间变化），但逆变器只有8个基本矢量。怎么用这8个基本矢量来合成我们想要的任意电压矢量呢？
SVPWM的思想就是：在一个PWM周期内，用相邻的两个有效矢量和零矢量，按时间比例组合，来合成目标电压矢量。满足伏秒平衡——在一个周期内，平均电压等于目标电压。
举个例子：如果目标电压矢量在第1扇区（U4和U6之间），那么在一个PWM周期内：
T1 × U4 + T2 × U6 + T0 × U0/7 = T × U_ref
其中：
- T是PWM周期
- T1是U4的作用时间
- T2是U6的作用时间
- T0是零矢量的作用时间（T0 = T - T1 - T2）
- U_ref是目标电压矢量
通过调整T1和T2的比例，可以合成扇区内任意角度和大小的电压矢量。
4.3 SVPWM的实现步骤
SVPWM算法的一般步骤：
第一步：判断扇区
根据Vα和Vβ的符号和大小，判断目标电压矢量落在哪个扇区（1-6扇区）。
第二步：计算两个相邻矢量的作用时间T1和T2
根据Vα、Vβ和直流母线电压，用几何方法或公式计算出两个相邻有效矢量的作用时间。
以第1扇区为例：
T1 = (√3×Vβ/2 - Vα/2) × T / Vdc
T2 = Vα × T / Vdc
其他扇区的公式类似，只是坐标变换一下。
第三步：过调制处理
如果T1+T2 > T（目标电压超过了逆变器的最大输出能力），需要进行过调制处理——按比例缩小T1和T2，保证T1+T2 ≤ T。
第四步：计算三相比较值
根据扇区号和T1、T2，计算出三相PWM的比较寄存器值（Ta, Tb, Tc），也就是每个桥臂的导通时间。
通常采用七段式SVPWM——每个周期按"零矢量→有效矢量1→有效矢量2→零矢量→有效矢量2→有效矢量1→零矢量"的顺序排列，每个周期切换7次。这样开关次数少，谐波小。
第五步：输出PWM
把计算好的比较值写入定时器的比较寄存器，由硬件自动生成PWM波形，驱动逆变器。
4.4 SVPWM vs SPWM
另一种常见的PWM方式是SPWM（正弦脉宽调制）——用三角波和正弦波比较，生成PWM。SVPWM和SPWM相比有什么区别呢？
| 对比项 | SPWM | SVPWM |
| 直流电压利用率 | 低（最大线电压幅值Vdc/√3≈0.577Vdc） | 高（最大线电压幅值2Vdc/3≈0.667Vdc），高15.47% |
| 谐波含量 | 较高 | 较低 |
| 算法复杂度 | 简单 | 稍复杂 |
| 开关损耗 | 相同开关频率下相当 | 相同开关频率下相当 |
| 电机运行效果 | 较好 | 更好（转矩脉动小，噪音低） |
SVPWM的直流电压利用率比SPWM高约15%，这意味着同样的母线电压下，电机可以获得更高的转速和更大的转矩。这也是SVPWM被广泛应用的重要原因之一。
德恩科磁悬浮自动门采用SVPWM技术，配合FOC矢量控制，充分发挥了电机的潜力，运行平稳，噪音低，效率高。
五、S型加减速曲线生成算法
自动门开关门是否平稳柔顺，很大程度上取决于速度曲线的规划。如果速度是突变的（梯形曲线的加减速阶段加速度是突变的），门就会有顿挫感；如果速度变化是平滑的（S型曲线，加速度连续变化），运行就非常平稳。
5.1 为什么需要S型加减速？
我们先从最简单的速度曲线说起：
1. 匀速运动（无加减速）
速度直接从0跳到设定速度，停止时直接从设定速度跳到0。加速度无穷大，冲击力巨大，体验极差，门体容易损坏。基本淘汰。
2. 梯形加减速（匀加减速）
速度曲线是梯形：加速段（匀加速）→ 匀速段 → 减速段（匀减速）。加速度是恒定的，加加速度（jerk，加加速度）是无穷大。
比匀速好很多，但加减速的起点和终点，加速度是突变的，会有冲击感，运行不够平顺。对于要求不高的场合可以用。
3. S型加减速
加减速过程中，加速度也是渐变的（不是突变的），速度曲线呈S形。加加速度（jerk）是有限的，运动非常平稳，没有冲击感。
S型曲线是目前最高级的速度规划方式，高端自动门都应该采用S型加减速。
5.2 S型曲线的分段
标准的7段S型速度曲线分为7个阶段：
速度 ▲ │ ┌───────────────┐ │ ╱ ╲ │ ╱ ╲ │ ╱ ╲ │ ╱ ╲ │ ╱ ╲ └──┴───────────────────────────┴──► 位移 T1 T2 T3 T4 T5 T6 T7 加加 匀加 减加 匀速 加减 匀减 减减
7个阶段分别是：
- 加加速段（Jerk恒定，加速度线性增加）：加速度从0增加到Amax，速度从0开始上升
- 匀加速段（加速度恒定Amax）：加速度保持最大，速度快速上升
- 减加速段（Jerk恒定负，加速度线性减小）：加速度从Amax减小到0，速度达到最大值Vmax
- 匀速段（速度恒定Vmax）：速度保持最大值，稳定运行
- 加减速段（Jerk恒定负，加速度负向增加）：加速度从0减小到-Amax（开始减速），速度开始下降
- 匀减速段（加速度恒定-Amax）：加速度保持最大负值，速度快速下降
- 减减速段（Jerk恒定正，加速度负向减小）：加速度从-Amax回到0，速度降到0
整个过程中，加加速度（Jerk）是有限的（不超过Jmax），加速度是连续变化的（没有突变），速度曲线是平滑的S形，位移曲线更是光滑。所以运行非常平稳，没有冲击。
如果行程比较短，可能达不到最大速度，就没有匀速段（5段S曲线）；如果行程更短，可能连最大加速度都达不到，就只有加加和减减段（3段S曲线）。实际应用中需要根据总行程和各参数自动计算用几段。
5.3 S型曲线的参数计算
S型曲线有几个关键参数：
- Jmax：最大加加速度（jerk），决定了冲击的大小。J越大，加加速度越大，冲击感越强；J越小，越平稳，但加减速时间越长。
- Amax：最大加速度，决定了加减速的快慢。A越大，加减速越快，但冲击越大。
- Vmax：最大运行速度，决定了匀速段的速度。
- S：总行程，门需要移动的总距离。
这些参数之间是相互制约的。一般来说，给定Jmax、Amax、Vmax、S，就可以计算出各段的时间和速度位移曲线。
计算过程比较繁琐，需要分情况讨论（能否达到最大加速度、能否达到最大速度等）。一般步骤是：
- 先假设能达到最大速度和最大加速度，计算各段时间和位移
- 如果总位移不够，说明达不到最大速度，去掉匀速段，重新计算
- 如果还是不够，说明连最大加速度都达不到，再去掉匀加/匀减段，重新计算
- 最后得到实际的各段参数
具体的计算公式比较复杂，就不在这里展开了。感兴趣的读者可以查阅运动控制相关的专业书籍。
5.4 S型曲线的实时生成
S型曲线怎么实时输出给速度环呢？有两种方式：
1. 离线计算+查表法
提前把整个S型曲线的速度/位置数据算好，存在数组里，运行时按时间索引查表输出。优点是实时计算量小，缺点是占用内存，而且行程或参数变化时需要重新计算。
2. 在线实时计算
运行时每个控制周期，根据当前时间和当前状态，实时计算下一个周期的速度/位置指令。优点是灵活，参数和行程可以随时变；缺点是计算量大，对处理器有一定要求。
对于自动门这种行程固定、参数基本不变的应用，两种方式都可以。德恩科采用的是在线实时计算的方式，更灵活，可以根据开门/关门、不同模式动态调整曲线参数。
5.5 S型曲线的工程实现技巧
1. 参数化配置
把Jmax、Amax、Vmax等参数做成可配置的，不同的门重、不同的使用场景可以调整参数。比如轻型门可以调快一点，重型门要调稳一点；医院等对静音要求高的场所，J可以调小一点，更平稳。
2. 位置闭环修正
理想的S曲线是开环的，但实际系统有负载变化、摩擦、阻力等干扰，纯开环会有位置误差。所以需要位置闭环——用位置PID来修正速度指令，确保最终位置准确。
3. 缓冲段设计
在全开和全关位置附近，可以设置低速缓冲段，最后一段以很低的速度缓慢到位，确保定位准确，同时减小到位冲击。
4. 动态调整
开门和关门可以用不同的曲线参数——开门快一点，关门慢一点更安全。有人的时候快一点，没人的时候慢一点更节能。
德恩科的S型加减速算法经过多代优化，参数丰富，配置灵活，可以适应各种门型和使用场景，运行平稳柔顺，体验非常好。
六、位置控制与轨迹规划
自动门不仅要跑得稳，还要停得准。位置控制的目标就是让门准确地停在目标位置。
6.1 位置控制的基本方式
1. 开环位置控制
没有位置反馈，靠脉冲数或时间来估算位置。比如步进电机的开环控制，给多少脉冲走多少步。
优点是简单、成本低。缺点是没有反馈，不知道实际位置，丢步了也不知道，精度差，不适合高精度应用。
自动门一般不用纯开环位置控制。
2. 半闭环位置控制
在电机轴上装编码器，检测电机的转角，间接计算门的位置。
优点是精度还可以，成本适中。缺点是传动机构的误差（皮带弹性、间隙、打滑等）没法补偿，精度受传动机构影响。
传统皮带传动的自动门大多是半闭环的。
3. 全闭环位置控制
直接在门体上装位置传感器（光栅尺、磁栅、直线编码器等），直接测量门的实际位置。
优点是精度最高，传动误差可以完全补偿。缺点是成本高，安装调试复杂。
磁悬浮自动门因为是直接驱动，没有传动机构，电机（动子）和门体直接连在一起，所以电机上的编码器就是门的位置，天然就是全闭环，精度很高。这也是直驱的优势之一。
6.2 点位控制与轨迹跟踪
位置控制有两种基本模式：
点位控制（PTP - Point to Point）：
只关心起点和终点的位置，不关心中间走什么路径。只要最终准确到达目标位置就行。比如自动门从"全开"到"全关"，只要最后准确关上就行。
点位控制比较简单，只要加减速规划好，最后位置准确就行。
轨迹跟踪控制（Contouring）：
不仅要到达终点，中间的运动路径（位置-时间曲线）也要严格跟踪。比如机床加工、3D打印等，路径精度很重要。
自动门一般是点位控制，对中间轨迹的要求不是特别严格，但好的自动门也会跟踪S型速度曲线，确保运行平稳。
6.3 定位精度与误差来源
自动门的定位精度受哪些因素影响呢？
1. 传感器精度
编码器的分辨率越高，位置检测越精确，定位精度就越高。
2. 控制算法
好的控制算法可以减小稳态误差，提高定位精度。PID参数整定合适，位置环增益足够高，精度就高。
3. 传动误差
皮带传动的话，皮带的弹性、伸长、打滑、齿隙等都会影响精度。直驱的话就没有这些问题。
4. 摩擦力与阻力变化
摩擦力的变化会导致位置误差。摩擦力大，到位时容易冲过头或者不到位。摩擦力补偿可以改善。
5. 负载变化
门体上挂了东西、风阻变化等，都会影响定位精度。
6. 环境因素
温度变化导致的热胀冷缩，也会影响位置精度（不过对自动门来说影响很小，可以忽略）。
对于磁悬浮自动门，因为是直驱，没有传动误差，而且摩擦力极小，所以定位精度很高，一般可以做到±0.5mm以内。
6.4 提高定位精度的方法
1. 提高传感器分辨率
用更高分辨率的编码器，这是基础。
2. 优化控制算法
- 提高位置环增益（但要注意稳定性）
- 加入前馈控制（速度前馈、加速度前馈），提高跟踪精度
- 摩擦力补偿，减小摩擦导致的误差
- 重力补偿（如果是竖直方向运动）
3. 采用全闭环
如果是传动的，尽量做全闭环，直接测门的位置。
4. 减小传动间隙和弹性
用高精度的传动机构（比如滚珠丝杠、同步带预紧）。
5. 慢就位（低速接近）
快到目标位置时，降低速度，缓慢到位，减小过冲，提高精度。
6.5 多段位置控制
自动门不只有开和关两个位置，有时候还需要中间位置。比如：
- 半开模式：门只开一半，节能
- 消防全开：火灾时门全开，方便疏散
- 门禁常开/常闭：不同时间段不同模式
- 分段速度：不同位置段用不同速度
这就需要控制系统支持多个目标位置的切换，并且能在运动过程中平滑地改变目标（比如开到一半突然有人要过，需要改变目标位置继续开门）。
好的位置控制算法应该支持在线改变目标位置和速度，并且切换平滑，没有冲击。
七、电流检测与防夹控制算法
安全是自动门的底线。防夹控制是安全保护的核心。除了安全光幕、安全底边等外部传感器，电机电流检测也是重要的防夹手段。
7.1 电流检测防夹的基本原理
基本思想很简单：正常关门时，电机的电流是基本稳定的（克服摩擦力和空气阻力）。如果门碰到了人或物体，电机的负载突然增大，电流也会突然升高。检测到电流超过阈值，就判断为遇到障碍物，立即停止关门并反向打开。
对于直流电机，电流和转矩近似成正比：T = Kt × I。所以电流的变化直接反映了负载转矩的变化。
对于FOC控制的永磁同步电机，q轴电流和转矩成正比：Te = 1.5×Pn×Φf×Iq。所以通过检测Iq就可以精确地知道转矩，从而判断是否遇阻。
这就是电流检测防夹的原理。
7.2 电流检测的方法
1. 采样电阻（分流器）
在主回路中串联一个小阻值的精密电阻，电流流过电阻产生电压降，通过测量电压降计算电流。
优点：简单、成本低、精度较高。
缺点：有损耗（I²R），不隔离，需要差分放大。
2. 电流互感器（CT）
利用电磁感应原理，原边电流在副边感应出比例电流。
优点：隔离、损耗小、适合大电流。
缺点：只能测交流，有相位误差，成本稍高。
3. 霍尔电流传感器
利用霍尔效应测量电流，可以测直流和交流。
优点：隔离、响应快、可以测直流。
缺点：成本高，有温漂。
4. 逆变器下桥臂采样
在三相逆变器的下桥臂分别串联采样电阻，通过下管导通时采样相电流。这是FOC控制中最常用的方法，成本低，效果好。
德恩科的控制器采用高精度采样电阻+差分放大的方式检测电流，配合12位以上的ADC，电流检测精度高，防夹灵敏可靠。
7.3 防夹控制的难点
电流防夹看起来简单，做好却不容易。主要难点有：
难点一：正常运行时电流也会变化
加减速时，电流本来就会变化（加速时电流大，减速时电流小）。如果只用一个固定的阈值，加速时可能误触发，减速时可能不灵敏。
解决方法：用动态阈值——根据当前的速度、加速度，计算出正常的电流值，在此基础上加上一个裕量作为阈值。实际电流超过动态阈值时才判断为遇阻。
难点二：摩擦力是变化的
不同位置摩擦力不一样，不同温度下摩擦力也不一样（冷态和热态），使用一段时间后摩擦力也会变化。固定的基准会不准。
解决方法：自适应基准——每次关门时，学习和更新正常的电流曲线，作为下一次的基准。这样可以适应摩擦力的缓慢变化。
难点三：门体惯量的影响
加减速时，需要克服门体惯量，电流会增大。而且速度变化越快，惯量电流越大。
解决方法：建立系统的数学模型，根据加速度计算惯量电流，从总电流中扣除，得到真正的阻力电流。
难点四：灵敏度和可靠性的平衡
灵敏度调太高，容易误触发（正常的摩擦波动也会触发）；灵敏度调太低，又不灵敏，真的夹到人了反应慢。
解决方法：多级检测策略——小幅度超调先减速观察，确认是真的障碍物再反向；同时结合外部传感器（光幕、底边）的信号，多重确认。
难点五：关门初期和末期的特殊情况
关门刚开始时，电机从静止启动，电流冲击大，容易误触发；关门末期，门快要合上时，密封条接触，阻力变大，也容易误触发。
解决方法：分段处理——启动段用特殊的启动逻辑，末端段降低灵敏度或用位置判断是否真的关到位。
7.4 德恩科防夹算法的特点
德恩科的电流检测防夹算法经过多年优化，具有以下特点：
- 自适应基准：自动学习正常阻力曲线，适应不同门体和环境变化
- 动态阈值：根据速度和加速度实时调整阈值，加减速不误触发，恒速时很灵敏
- 多级判断：先减速确认，确认后再反向，既灵敏又可靠
- 分段处理：启动段、中间段、末端段分别处理，适应不同位置的特点
- 多重保护：电流检测+安全光幕+安全底边三重防夹，层层保护
- 符合标准：防夹力≤150N，符合国家和国际安全标准
三重防夹保护确保使用安全，让用户用得放心。
八、德恩科控制算法研发与应用
德恩科拥有一支专业的控制算法研发团队，在电机控制、运动控制、安全控制等方面积累了丰富的经验。
8.1 控制算法研发团队
德恩科的控制算法团队由来自重点大学和知名企业的工程师组成，专业背景涵盖电机与电器、电力电子与电力传动、控制科学与工程、嵌入式系统等。团队成员在电机控制、运动控制、嵌入式开发等领域有多年的研发经验。
8.2 核心控制技术
1. 高性能FOC矢量控制
自研的FOC矢量控制算法，针对磁悬浮直线电机优化，转矩脉动小，运行平稳，噪音低，效率高。支持Id=0控制、最大转矩电流比控制等多种控制策略。
2. 高精度位置控制
位置环+速度环+电流环三环全闭环控制，配合高精度磁编码器，定位精度高，运行平稳。支持前馈控制、摩擦力补偿等高级功能。
3. 优化的S型加减速
7段S型加减速曲线，参数丰富可配置，运行平稳柔顺。支持在线改变目标位置和速度，切换平滑无冲击。
4. 灵敏可靠的防夹控制
自适应电流检测防夹算法，配合安全光幕和安全底边，三重防夹保护，既灵敏又可靠，符合安全标准。
5. 丰富的功能接口
支持多种传感器接入（微波雷达、红外、光幕、底边等），支持多种开门方式（感应、遥控、刷卡、指纹、人脸等），支持消防联动、门禁联动、多门互锁等功能。
6. 物联网与智能功能
可选配WiFi/4G/以太网联网功能，支持远程监控、远程控制、故障预警、数据统计等物联网功能。
8.3 产品系列与平台化
德恩科的控制平台是通用化、平台化的，同一个控制硬件和软件平台，通过配置不同的参数和功能模块，就可以适配不同系列的产品：
- 轻型门（DK-MINI系列）
- 标准门（DK-STD系列）
- 重型门（DK-HVY系列）
- 超重型门（DK-UHV系列）
- 快速门（DK-FST系列）
- 医用门（DK-MED系列）
- 弧形门（DK-CRV系列）
平台化的好处是：研发效率高，质量稳定，维护方便，客户可以得到一致的使用体验。
技术咨询与合作：
如果您对控制算法感兴趣，或者有特殊功能需求，欢迎联系德恩科技术团队。
咨询电话：132-7159-7000（微信同号）
品牌：德恩科 · 河南联同创智能科技有限公司
服务：免费技术咨询 · 免费方案设计 · 免费现场勘测 · 全国上门安装
九、常见技术问题解答（FAQ）
本文由德恩科磁悬浮自动门技术团队整理发布 | 河南联同创智能科技有限公司 | 技术咨询：132-7159-7000
