feat(FOC): 优化SVPWM算法并重构角度控制逻辑

- 引入新的三值约束宏 `_constrain3` 用于SVPWM计算优化
- 修改 `setPhaseVoltage` 函数签名，移除冗余的角度参数，内部自动计算电气角度
- 调整PWM占空比计算方式，提高电压利用率和控制精度
- 移除旧的DEG2RAD和RAD2DEG常量定义，改由initial.h统一管理
- 在initial.h中新增减速比常量REDUCTION_RATIO，并修正拼写错误
- 为角度传感器类更新速度滤波器尺寸，提升速度估算稳定性
- 更新PID控制器时间片常量，简化dt计算逻辑，提高执行效率
- 切换角度闭环控制至新NPID版本，增强系统响应性能
- 修正CAN通信中的目标角度解析逻辑，确保指令正确应用

Robot_V2/device/ang_sensor.cpp

@@ -5,6 +5,7 @@
 #include <cstdio>
 #include <cstring>
 #include <stdint.h>
+#include "initial.h"
 
 #define SPI_CS_ENABLE() gpio_bit_reset(GPIOA, GPIO_PIN_15)
 #define SPI_CS_DISABLE() gpio_bit_set(GPIOA, GPIO_PIN_15)
@@ -13,7 +14,6 @@ constexpr float ANGLE_FACTOR = 1.0f / 65536.0f * 360.0f;
 constexpr float RAD_FACTOR = 1.0f / 65536.0f * 2.0f * 3.14159265358979323846f;
 constexpr u16 DEFAULT_COMMAND = 0x0000;
 constexpr u16 FAULT_RECEIVE = 0xFFFF;
-constexpr u16 REDDUCTION_RATIO = 25;
 constexpr float VELOCITY_SCALE = 1e4f;
 constexpr float ANGLE_WRAP_THRESHOLD = 270.0f;
 constexpr float ANGLE_WRAP_VALUE = 360.0f;
@@ -259,7 +259,7 @@ float angle_sensor::update(void) {
  * @return 累积角度值
  */
 float angle_sensor::getAngle(void) const {
-	return m_cumulativeAngle / REDDUCTION_RATIO;
+	return m_cumulativeAngle / REDUCTION_RATIO;
 }
 
 /**
@@ -273,7 +273,7 @@ float angle_sensor::getRawAngle(void) const { return m_cumulativeAngle; }
  * @return 速度值(输出级)
  */
 float angle_sensor::getVelocity(void) const {
-	return getRawVelocity() / REDDUCTION_RATIO;
+	return getRawVelocity() / REDUCTION_RATIO;
 }
 
 /**