刻看電機(jī)控制：選型、FOC與PID實(shí)戰(zhàn)解析)
最近有個(gè)挺有意思的現(xiàn)象一款會(huì)走路的玩具鴨火了據(jù)說(shuō)賣(mài)到 4 秒一只連做機(jī)器人的宇樹(shù)科技都開(kāi)始在公開(kāi)場(chǎng)合拿電機(jī)說(shuō)事。很多人第一反應(yīng)是“這鴨子憑什么賣(mài)爆”但搞嵌入式的人看到的是另一層一個(gè)爆款消費(fèi)電子產(chǎn)品的背后電機(jī)和控制方案才是真正的命門(mén)。更有意思的是評(píng)論區(qū)里總有人問(wèn)“能不能復(fù)刻一只”“自己買(mǎi)電機(jī)做要多少錢(qián)”然后算完賬發(fā)現(xiàn)一個(gè)尷尬的事實(shí)單算電機(jī)、驅(qū)動(dòng)板、結(jié)構(gòu)件、調(diào)試時(shí)間復(fù)刻一只的成本往往比直接買(mǎi)成品還貴。這篇文章不聊那只鴨子本身值不值得買(mǎi)而是借此把“網(wǎng)紅爆款里的電機(jī)復(fù)刻”這件事講透。核心內(nèi)容分為幾塊爆款產(chǎn)品里用的電機(jī)到底是什么類(lèi)型為什么它比普通直流電機(jī)難復(fù)刻復(fù)刻的成本到底高在哪里如果你真想動(dòng)手從電機(jī)選型到驅(qū)動(dòng)板設(shè)計(jì)再到控制算法完整的技術(shù)路徑應(yīng)該怎么走。讀完之后你會(huì)得到一份能夠直接指導(dǎo)實(shí)踐的電機(jī)復(fù)刻技術(shù)地圖包括硬件選型、FOC 控制原理、三環(huán)調(diào)試順序、常見(jiàn)坑和排查思路。不管你是想做個(gè)機(jī)械臂關(guān)節(jié)、小車(chē)底盤(pán)還是純粹想搞懂爆款產(chǎn)品背后的動(dòng)力系統(tǒng)這篇文章都值得收藏。1. 這篇文章真正要解決的問(wèn)題先直接給結(jié)論爆款玩具鴨的核心技術(shù)含量不在外觀而在動(dòng)力系統(tǒng)。它要在受限的體積、成本、電池容量下實(shí)現(xiàn)穩(wěn)定行走、轉(zhuǎn)向、姿態(tài)糾正這不是一個(gè)普通 TT 馬達(dá)加兩個(gè)輪子就能搞定的方案。復(fù)刻它的難點(diǎn)也不在 3D 打印外殼而在三個(gè)維度電機(jī)選型什么樣的電機(jī)能在小體積下給出足夠扭矩同時(shí)續(xù)航還能撐住。驅(qū)動(dòng)方案是選有刷直流電機(jī)加 H 橋還是無(wú)刷電機(jī)加 FOC 控制器?？刂崎]環(huán)行走時(shí)的PID參數(shù)調(diào)校、堵轉(zhuǎn)保護(hù)、電池電壓跌落補(bǔ)償這些才是調(diào)試時(shí)間的大頭。所以這篇文章真正要解決的不是“怎么把鴨子抄出來(lái)賣(mài)”而是當(dāng)你看到一個(gè)爆款硬件產(chǎn)品時(shí)怎么用電機(jī)控制的知識(shí)拆解它并且實(shí)際動(dòng)手做出一個(gè)能跑的控制系統(tǒng)。對(duì)于正在學(xué) STM32 電機(jī)控制、BLDC 驅(qū)動(dòng)、FOC 算法的嵌入式開(kāi)發(fā)者來(lái)說(shuō)這是一篇把概念、選型、代碼、調(diào)試串起來(lái)的實(shí)戰(zhàn)向文章。2. 爆款玩具鴨的電機(jī)到底是什么類(lèi)型從材料看這類(lèi)產(chǎn)品選用的核心動(dòng)力是小尺寸空心杯電機(jī)或微型無(wú)刷減速電機(jī)配合行星齒輪減速箱輸出扭矩。它和我們常見(jiàn)的 130 電機(jī)、TT 馬達(dá)有一個(gè)本質(zhì)區(qū)別自帶減速機(jī)構(gòu)輸出的是低速大扭矩。2.1 為什么需要減速箱玩具鴨行走時(shí)輪子轉(zhuǎn)速其實(shí)不高但需要克服地面摩擦和自身重量。如果直接用高速電機(jī)帶動(dòng)輪子扭矩不夠起步困難轉(zhuǎn)向時(shí)還會(huì)打滑。普通玩具常見(jiàn)做法是高速電機(jī)加減速齒輪常見(jiàn)減速比從 10:1 到 30:1。扭矩通過(guò)減速比放大但代價(jià)是轉(zhuǎn)速下降、整體效率下降、噪音上升。爆款鴨這類(lèi)產(chǎn)品通常使用定制減速箱減速比經(jīng)過(guò)仔細(xì)計(jì)算保證一輪電池能持續(xù)行走幾百米。2.2 無(wú)刷還是有刷這是復(fù)刻時(shí)最容易糾結(jié)的問(wèn)題。電機(jī)類(lèi)型優(yōu)點(diǎn)缺點(diǎn)適用場(chǎng)景有刷直流電機(jī)驅(qū)動(dòng)簡(jiǎn)單、控制成熟、成本低碳刷磨損、噪音大、效率低普通玩具、簡(jiǎn)單小車(chē)空心杯有刷電機(jī)慣量小、響應(yīng)快、體積小成本略高、仍存在機(jī)械換向高端玩具、航模舵機(jī)無(wú)刷直流電機(jī) BLDC壽命長(zhǎng)、效率高、噪音低驅(qū)動(dòng)復(fù)雜、需要 FOC 或方波控制無(wú)人機(jī)、機(jī)器人、高端產(chǎn)品從爆款產(chǎn)品的壽命、靜音和續(xù)航要求來(lái)看無(wú)刷方案更符合產(chǎn)品定位。但對(duì)于想快速?gòu)?fù)刻原型驗(yàn)證的開(kāi)發(fā)者先用有刷電機(jī)加編碼器跑通閉環(huán)再替換成無(wú)刷方案才是更穩(wěn)的工程路徑。這里要糾正一個(gè)常見(jiàn)誤區(qū)**無(wú)刷電機(jī)不一定是更高級(jí)的選擇它在低速大扭矩場(chǎng)景下對(duì)控制算法要求很高。**方波控制噪音大、頓挫感明顯FOC 控制效果好但調(diào)試門(mén)檻高。新手第一次做無(wú)刷項(xiàng)目很容易卡在換向時(shí)序上。3. 復(fù)刻一只鴨子為什么比買(mǎi)成品還貴這個(gè)問(wèn)題很有討論價(jià)值因?yàn)樗┞读撕芏嘤布_(kāi)發(fā)者的認(rèn)知盲區(qū)。看起來(lái)一只鴨子賣(mài)幾十塊里面電機(jī)成本可能只有幾塊錢(qián)到十幾塊錢(qián)。自己去買(mǎi)電機(jī)、減速箱、輪子、驅(qū)動(dòng)板、電池、外殼單件成本加起來(lái)好像也不高。但實(shí)際上真實(shí)成本分布是這樣的3.1 BOM 成本不是全部從材料看個(gè)人復(fù)刻時(shí)容易忽略的成本包括打樣成本3D 打印一個(gè)外殼加結(jié)構(gòu)件材料費(fèi)不高但反復(fù)迭代修改的機(jī)時(shí)成本很高。采購(gòu)零散化成本個(gè)人買(mǎi)電機(jī)是零售價(jià)工廠用的是批量?jī)r(jià)差價(jià)通常有 3 到 5 倍。調(diào)試時(shí)間成本PID 參數(shù)整定、機(jī)械結(jié)構(gòu)干涉、電池電壓跌落導(dǎo)致的電機(jī)非線(xiàn)性表現(xiàn)這些都是隱形消耗。模具與工藝成本量產(chǎn)外殼是注塑工藝一次模具費(fèi)可能上萬(wàn)但分?jǐn)偟綆兹f(wàn)個(gè)產(chǎn)品上就很低。3.2 核心技術(shù)在控制不在零件爆款鴨能穩(wěn)定走直線(xiàn)背后可能不是重力回正而是編碼器加 PID 閉環(huán)或者機(jī)械限位結(jié)構(gòu)。抄外殼容易抄控制邏輯難。舉個(gè)我們?cè)跈C(jī)器人關(guān)節(jié)里常見(jiàn)的例子同一個(gè)電機(jī)配上不同的減速比和控制算法做出來(lái)的運(yùn)動(dòng)性能天差地別。有人用 6020 電機(jī)做機(jī)械臂關(guān)節(jié)有人用 3508 電機(jī)配好好減速比最終效果完全不同。所以復(fù)刻比買(mǎi)貴的本質(zhì)是你在為“可靠性和穩(wěn)定性”付錢(qián)不是為“零件”付錢(qián)。4. 電機(jī)復(fù)刻的最小技術(shù)路徑如果你看完上面的成本分析還是決定動(dòng)手復(fù)刻一套動(dòng)力系統(tǒng)來(lái)學(xué)習(xí)下面這條技術(shù)路徑可以作為起點(diǎn)。4.1 第一步明確運(yùn)動(dòng)需求先列出你希望最終產(chǎn)品具備的運(yùn)動(dòng)參數(shù)整車(chē)或整機(jī)重量。最大速度。最大爬坡角度。電池電壓和容量。續(xù)航時(shí)間。這些參數(shù)直接決定電機(jī)功率和減速比。一個(gè)粗略估算公式所需扭矩 T (整車(chē)重量 × 重力加速度 × 滾動(dòng)摩擦系數(shù)) × 輪子半徑假設(shè)整車(chē)重量 500g摩擦系數(shù) 0.15輪子半徑 30mmweight 0.5 # kg g 9.8 mu 0.15 wheel_radius 0.03 # m torque weight * g * mu * wheel_radius print(f所需扭矩約 {torque:.3f} N·m)輸出所需扭矩約 0.022 N·m這個(gè)扭矩看起來(lái)很小但注意這只是勻速運(yùn)動(dòng)下的扭矩。起步加速、上坡、越過(guò)障礙都需要額外余量通常要乘以 2 到 3 倍的安全系數(shù)。4.2 第二步選擇電機(jī)類(lèi)型建議從下面這條決策路徑走如果想快速跑通原型、先驗(yàn)證控制邏輯建議使用帶編碼器的有刷直流電機(jī)如常見(jiàn)的 GA12-N20 減速電機(jī)。它自帶減速箱和霍爾編碼器控制方便驅(qū)動(dòng)芯片便宜。如果目標(biāo)是學(xué)習(xí) BLDC 和 FOC建議選擇云臺(tái)電機(jī)、航模電機(jī)或機(jī)器人關(guān)節(jié)電機(jī)比如常見(jiàn)的大疆 3508、M2006或國(guó)產(chǎn) 6020 電機(jī)。這類(lèi)電機(jī)扭矩密度高但必須搭配對(duì)應(yīng)驅(qū)動(dòng)器和上位機(jī)才能工作。如果是純學(xué)習(xí)電機(jī)控制原理不追求實(shí)際產(chǎn)品效果可以直接用 Gimbal 電機(jī)自己搭 FOC 驅(qū)動(dòng)板使用 STM32G4 系列 MCU配合三電阻采樣方案。4.3 第三步設(shè)計(jì)驅(qū)動(dòng)方案有刷電機(jī)驅(qū)動(dòng)相對(duì)簡(jiǎn)單使用 PWM 加 H 橋即可。無(wú)刷電機(jī)需要設(shè)計(jì)三相逆變電橋和轉(zhuǎn)子位置檢測(cè)電路。這是兩類(lèi)方案的核心差異對(duì)比項(xiàng)有刷直流電機(jī)無(wú)刷直流電機(jī)驅(qū)動(dòng)電路H 橋或雙 H 橋三相全橋逆變器換向方式機(jī)械換向電子換向轉(zhuǎn)子位置檢測(cè)編碼器可選霍爾傳感器或反電動(dòng)勢(shì)檢測(cè)控制算法單環(huán) PID 即可方波換向或 FOC開(kāi)發(fā)難度低高新手容易忽略的一點(diǎn)是**無(wú)刷電機(jī)必須知道轉(zhuǎn)子當(dāng)前位置才能決定先給哪兩相通電。**如果你用反電動(dòng)勢(shì)過(guò)零檢測(cè)BEMF需要考慮電機(jī)轉(zhuǎn)速和反電動(dòng)勢(shì)幅值成正比的問(wèn)題低速啟動(dòng)時(shí)會(huì)非常難處理。所以實(shí)際項(xiàng)目中位置檢測(cè)方式先選帶霍爾傳感器的電機(jī)不要一上來(lái)就玩無(wú)感 FOC。5. 從零搭一套電機(jī)控制 Demo下面我們用 STM32 平臺(tái)搭一套最簡(jiǎn)單的有刷直流電機(jī) PID 速度閉環(huán)再加上編碼器反饋。這套方案雖然不涉及無(wú)刷電機(jī)但它是理解無(wú)刷電機(jī)三環(huán)控制的基礎(chǔ)。5.1 硬件清單STM32F407ZGT6 開(kāi)發(fā)板。GB37Y3530 直流減速電機(jī)帶 AB 相霍爾編碼器。L298N 或 TB6612 電機(jī)驅(qū)動(dòng)模塊。12V 鋰電池或直流電源。USB-TTL 串口模塊。這里重點(diǎn)說(shuō)一下驅(qū)動(dòng)模塊的選擇。L298N 經(jīng)典但壓降大在電池供電場(chǎng)景下效率不理想TB6612 屬于 H 橋驅(qū)動(dòng)導(dǎo)通電阻小適合中小功率直流電機(jī)。從材料看很多初學(xué)者做 STM32 控制 3508、TB6612 驅(qū)動(dòng)選型最終卡在供電不穩(wěn)上。這里提醒一點(diǎn)電機(jī)驅(qū)動(dòng)模塊的電源和 MCU 電源必須隔離或至少共地但不要互相干擾否則容易導(dǎo)致單片機(jī)復(fù)位的詭異 Bug。5.2 初始化定時(shí)器編碼器模式我們使用定時(shí)器 3 的編碼器模式讀取電機(jī) AB 相。// 文件路徑Src/tim.c void MX_TIM3_Init_Encoder(void) { GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_TIM3_CLK_ENABLE(); __HAL_RCC_GPIOA_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6 | GPIO_PIN_7; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM3; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); htim3.Instance TIM3; htim3.Init.Prescaler 0; htim3.Init.CounterMode TIM_COUNTERMODE_UP; htim3.Init.Period 65535; htim3.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; htim3.Init.AutoReloadPreload TIM_AUTORELOAD_PRELOAD_DISABLE; HAL_TIM_Encoder_Init(htim3); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); }這里關(guān)鍵點(diǎn)在于編碼器模式使用兩個(gè)通道輸入自動(dòng)根據(jù) AB 相位差判斷旋轉(zhuǎn)方向。計(jì)數(shù)器是 16 位的計(jì)數(shù)超過(guò) 65535 會(huì)溢出回繞需要在軟件里做溢出補(bǔ)償。GPIO 必須配置為復(fù)用推挽模式否則讀不到脈沖。5.3 電機(jī) PWM 輸出我們使用定時(shí)器 4 通道 1 輸出 PWM 控制電機(jī)轉(zhuǎn)速。// 文件路徑Src/motor.c #include motor.h void Motor_Init(void) { GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_TIM4_CLK_ENABLE(); __HAL_RCC_GPIOB_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM4; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); htim4.Instance TIM4; htim4.Init.Prescaler 84 - 1; htim4.Init.CounterMode TIM_COUNTERMODE_UP; htim4.Init.Period 1000 - 1; htim4.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; HAL_TIM_PWM_Init(htim4); TIM_OC_InitTypeDef sConfigOC {0}; sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 0; sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(htim4, sConfigOC, TIM_CHANNEL_1); HAL_TIM_PWM_Start(htim4, TIM_CHANNEL_1); } void Motor_SetSpeed(int16_t speed) { if (speed 0) { // 正轉(zhuǎn)方向設(shè)置引腳 HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_RESET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, speed); } else if (speed 0) { HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, -speed); } else { HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, 0); } }這里的 PWM 頻率是 84MHz 除以 84預(yù)分頻再除以 1000自動(dòng)重裝載大約 1kHz。**電機(jī)驅(qū)動(dòng)的 PWM 頻率通常選 10kHz 到 20kHz 更合適可以減少電流紋波和電磁噪音。**上面的寫(xiě)法只是為了演示實(shí)際項(xiàng)目建議把 Period 改成 4200得到 20kHz。5.4 速度閉環(huán) PID速度環(huán)需要實(shí)時(shí)讀取編碼器計(jì)數(shù)并轉(zhuǎn)換成轉(zhuǎn)速值。// 文件路徑Src/pid.c typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; } PID_t; void PID_Init(PID_t *pid, float kp, float ki, float kd) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-integral 0; pid-prev_error 0; } float PID_Update(PID_t *pid, float target, float current) { float error target - current; pid-integral error; float derivative error - pid-prev_error; pid-prev_error error; return pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; }調(diào)用邏輯一般是// 文件路徑Src/main.c int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_TIM3_Init_Encoder(); Motor_Init(); PID_t speed_pid; PID_Init(speed_pid, 0.3f, 0.05f, 0.0f); int16_t target_speed 200; // 目標(biāo)轉(zhuǎn)速編碼器計(jì)數(shù)差值 while (1) { int16_t current_speed TIM3-CNT - last_count; last_count TIM3-CNT; int16_t pwm_output PID_Update(speed_pid, target_speed, current_speed); Motor_SetSpeed(pwm_output); HAL_Delay(10); } }注意這個(gè)速度環(huán)只是最小演示。實(shí)際項(xiàng)目里應(yīng)該在定時(shí)器中斷里做固定頻率的 PID 計(jì)算而不是在 while 循環(huán)里用 HAL_Delay因?yàn)?HAL_Delay 的不確定性會(huì)影響 PID 采樣周期導(dǎo)致控制不穩(wěn)定。6. 進(jìn)階BLDC 電機(jī)與 FOC 控制如果你已經(jīng)跑通有刷閉環(huán)下一步就可以轉(zhuǎn)向無(wú)刷電機(jī)和 FOC這也是機(jī)器人關(guān)節(jié)、無(wú)人機(jī)、爆款無(wú)刷玩具里最常見(jiàn)的技術(shù)路線(xiàn)。6.1 FOC 在解決什么問(wèn)題有刷電機(jī)通過(guò)改變 PWM 占空比可以直接控制兩端電壓控制量是標(biāo)量。無(wú)刷電機(jī)的三相繞組需要按轉(zhuǎn)子位置同步換向控制目標(biāo)是讓定子磁場(chǎng)始終和轉(zhuǎn)子磁場(chǎng)保持 90 度相位差這樣才能輸出最大扭矩。FOC磁場(chǎng)定向控制的核心思想是把三相電流通過(guò) Clarke 變換和 Park 變換從靜止坐標(biāo)系轉(zhuǎn)換到轉(zhuǎn)子同步旋轉(zhuǎn)坐標(biāo)系讓電流環(huán)可以像控制直流電機(jī)一樣控制交軸電流 Iq 和直軸電流 Id。其中Iq 控制扭矩輸出。Id 通常控制在 0避免削弱磁場(chǎng)。電流環(huán)需要高速執(zhí)行典型頻率是 10kHz 到 20kHz。速度環(huán)和位置環(huán)在電流環(huán)上層典型頻率是 1kHz 左右。6.2 硬件方案從材料看STM32G4 系列是當(dāng)前做電機(jī)控制的性?xún)r(jià)比選擇。它內(nèi)置了適合電機(jī)控制的外設(shè)高精度定時(shí)器 HRTIM、運(yùn)算放大器、比較器、ADC 硬件過(guò)采樣。常見(jiàn)驅(qū)動(dòng)方案功率管FD6288T 或 EG2134 等三相柵極驅(qū)動(dòng)芯片。MOS 管根據(jù)電機(jī)電流選擇常見(jiàn) 40V/30A 規(guī)格。采樣方式三電阻采樣或單電阻采樣。編碼器磁編碼器或光電編碼器常用 AS5600、MT6701。6.3 電流環(huán)代碼結(jié)構(gòu)FOC 代碼通常包含// 文件路徑Src/foc.c float clamp_val(float value, float max_val) { return (value max_val) ? max_val : (value -max_val) ? -max_val : value; } void FOC_CurrentLoop(float target_iq, float target_id, float i_alpha, float i_beta, float theta_elec) { // Park 變換 float i_d i_alpha * cosf(theta_elec) i_beta * sinf(theta_elec); float i_q -i_alpha * sinf(theta_elec) i_beta * cosf(theta_elec); // PI 調(diào)節(jié)器 float v_d PID_Update(pid_d, target_id, i_d); float v_q PID_Update(pid_q, target_iq, i_q); // 反 Park 變換 float v_alpha v_d * cosf(theta_elec) - v_q * sinf(theta_elec); float v_beta v_d * sinf(theta_elec) v_q * cosf(theta_elec); // SVPWM 調(diào)制輸出 SVPWM_Update(v_alpha, v_beta); }這段代碼是 FOC 電流環(huán)的最小骨架。對(duì)于新手最重要的不是背公式而是先理解每個(gè)變量在物理上對(duì)應(yīng)什么。7. 電機(jī)控制常見(jiàn)問(wèn)題與排查思路無(wú)論有刷還是無(wú)刷調(diào)試中最常見(jiàn)的問(wèn)題集中在電源、換向、反饋三大塊。問(wèn)題現(xiàn)象可能原因排查方式解決方案電機(jī)不轉(zhuǎn)驅(qū)動(dòng)板供電不足用萬(wàn)用表測(cè)電機(jī)端電壓、PWM 輸出單獨(dú)給電機(jī)供電確認(rèn)共地電機(jī)抖動(dòng)編碼器 AB 相接反檢查編碼器線(xiàn)序查看計(jì)數(shù)方向交換 A、B 相或調(diào)整計(jì)數(shù)方向PID 速度震蕩Kp 過(guò)大、Ki 過(guò)大減小 KpKi 先設(shè) 0觀察響應(yīng)曲線(xiàn)先調(diào) Kp 找到臨界再加 Ki 消除穩(wěn)態(tài)誤差電機(jī)正反轉(zhuǎn)不均勻換向邏輯有誤輸出固定 PWM觀察轉(zhuǎn)向和方向引腳電平關(guān)系統(tǒng)一電機(jī)方向定義前端校準(zhǔn)BLDC 無(wú)法啟動(dòng)無(wú)感方波啟動(dòng)電流不足提升啟動(dòng) PWM 占空比確認(rèn)換向順序改用帶霍爾傳感器的電機(jī)FOC 電流采樣噪聲大采樣時(shí)機(jī)和 PWM 占空比重合檢查 ADC 采樣觸發(fā)點(diǎn)使用中心對(duì)齊 PWM在計(jì)數(shù)器歸零時(shí)采樣電機(jī)發(fā)熱嚴(yán)重PWM 頻率過(guò)低或采樣電阻功率不足測(cè) PWM 頻率和相電流波形提高 PWM 頻率至 20kHz 左右單片機(jī)復(fù)位電機(jī)反電動(dòng)勢(shì)干擾電源示波器抓 MCU 供電紋波增加電源去耦電容分路供電8. 最佳實(shí)踐與工程建議電機(jī)控制項(xiàng)目里最容易拉低進(jìn)度的不是算法本身而是工程習(xí)慣。8.1 硬件設(shè)計(jì)建議電機(jī)驅(qū)動(dòng)部分和主控部分分開(kāi)供電至少分開(kāi)走線(xiàn)最后單點(diǎn)共地。在電機(jī)供電入口加一個(gè)大容量電解電容和陶瓷電容吸收反電動(dòng)勢(shì)尖峰。編碼器信號(hào)線(xiàn)走短使用雙絞線(xiàn)或屏蔽線(xiàn)避免和 PWM 線(xiàn)平行。采樣電阻選低電感類(lèi)型比如合金電阻采樣電壓信號(hào)經(jīng)過(guò) RC 濾波后再進(jìn) ADC。8.2 軟件設(shè)計(jì)建議所有 PID 參數(shù)保存到 Flash 或配置文件不要硬編碼在源碼里。調(diào)試階段使用串口或 USB 虛擬串口輸出實(shí)時(shí)轉(zhuǎn)速、電流、目標(biāo)值方便畫(huà)曲線(xiàn)?？刂浦芷诒仨氂枚〞r(shí)器中斷觸發(fā)不要在 while 循環(huán)里依賴(lài)流水線(xiàn)執(zhí)行時(shí)間。在電流環(huán)內(nèi)部不要做浮點(diǎn)打印操作浮點(diǎn)運(yùn)算和串口輸出會(huì)占用大量時(shí)間。加入限幅PWM 輸出和 PI 積分項(xiàng)都要限幅防止啟動(dòng)瞬間積分飽和導(dǎo)致超調(diào)失控。8.3 安全與測(cè)試建議任何電機(jī)上電測(cè)試前確認(rèn)機(jī)械機(jī)構(gòu)沒(méi)有卡住避免堵轉(zhuǎn)電流燒毀驅(qū)動(dòng)器。第一次通電時(shí)使用限流電源把電流限制在額定電流的 50% 以下。無(wú)刷電機(jī)換向錯(cuò)誤會(huì)導(dǎo)致過(guò)流務(wù)必在代碼中實(shí)現(xiàn)過(guò)流保護(hù)邏輯。如果要控制一號(hào)機(jī)器人關(guān)節(jié)或 3508 這類(lèi)高扭矩電機(jī)啟動(dòng)前先把目標(biāo)值設(shè)為零然后手動(dòng)緩慢增加。8.4 參數(shù)內(nèi)部處理建議引力爆款產(chǎn)品里見(jiàn)的電機(jī)參數(shù)比如扭矩、轉(zhuǎn)速、減速比很多來(lái)自廠家手冊(cè)。但實(shí)際上電機(jī)的空載轉(zhuǎn)速、堵轉(zhuǎn)扭矩和額定扭矩之間是非線(xiàn)性關(guān)系電機(jī)實(shí)際表現(xiàn)還會(huì)隨電池電壓跌落而變化。更穩(wěn)妥的做法是在樣機(jī)上做一組實(shí)測(cè)空載轉(zhuǎn)速用碼盤(pán)或示波器測(cè)出霍爾頻率換算。堵轉(zhuǎn)電流用鉗形表測(cè)電機(jī)短路狀態(tài)下的電流。不同電壓下的轉(zhuǎn)速-扭矩曲線(xiàn)至少測(cè) 7.4V、11.1V、12V 三組。只有拿到這些實(shí)測(cè)數(shù)據(jù)PID 參數(shù)才有意義否則全靠猜。9. 總結(jié)與后續(xù)學(xué)習(xí)方向回到開(kāi)頭的問(wèn)題復(fù)刻一只 4 秒賣(mài)出的爆款鴨為什么比直接買(mǎi)還貴從電機(jī)控制的角度看答案很明確爆款產(chǎn)品真正的護(hù)城河是產(chǎn)品定義能力和工程調(diào)優(yōu)能力。電機(jī)選型、減速比計(jì)算、控制算法、結(jié)構(gòu)與運(yùn)動(dòng)的配合每一項(xiàng)都需要大量試錯(cuò)沉淀。個(gè)人復(fù)刻要付出時(shí)間和試錯(cuò)成本而量產(chǎn)工廠把這些成本分散到了幾十萬(wàn)個(gè)訂單上。對(duì)于想要學(xué)習(xí)電機(jī)控制的開(kāi)發(fā)者最值得投入的方向是把有刷電機(jī)的 PID 速度環(huán)和位置環(huán)跑順再進(jìn)入 BLDC 的方波控制和 FOC 控制然后重點(diǎn)研究電機(jī)三環(huán)控制架構(gòu)里的電流環(huán)、速度環(huán)、位置環(huán)的時(shí)序關(guān)系。硬件上可以用 STM32G4 加三相驅(qū)動(dòng)板自研一套低成本 FOC 驅(qū)動(dòng)配合 AS5600 磁編碼器調(diào)試。從材料看STM32G4、3508、TB6612、6020 這類(lèi)關(guān)鍵詞在電機(jī)控制社區(qū)里高頻出現(xiàn)說(shuō)明這是一整套成熟的學(xué)習(xí)路徑。與其糾結(jié)怎么復(fù)刻別人已經(jīng)量產(chǎn)的爆款不如從拆解它的需求出發(fā)做一個(gè)屬于你自己的“電機(jī)控制小樣機(jī)”。什么時(shí)候你能用自己的驅(qū)動(dòng)板把電機(jī)從參數(shù)配置到閉環(huán)調(diào)試完整跑通你就真正摸到了爆款產(chǎn)品背后那塊最核心的技術(shù)底座。 從玩具鴨復(fù)刻看電機(jī)控制：選型、FOC與PID實(shí)戰(zhàn)解析
最近有個(gè)挺有意思的現(xiàn)象一款會(huì)走路的玩具鴨火了據(jù)說(shuō)賣(mài)到 4 秒一只連做機(jī)器人的宇樹(shù)科技都開(kāi)始在公開(kāi)場(chǎng)合拿電機(jī)說(shuō)事。很多人第一反應(yīng)是“這鴨子憑什么賣(mài)爆”但搞嵌入式的人看到的是另一層一個(gè)爆款消費(fèi)電子產(chǎn)品的背后電機(jī)和控制方案才是真正的命門(mén)。更有意思的是評(píng)論區(qū)里總有人問(wèn)“能不能復(fù)刻一只”“自己買(mǎi)電機(jī)做要多少錢(qián)”然后算完賬發(fā)現(xiàn)一個(gè)尷尬的事實(shí)單算電機(jī)、驅(qū)動(dòng)板、結(jié)構(gòu)件、調(diào)試時(shí)間復(fù)刻一只的成本往往比直接買(mǎi)成品還貴。這篇文章不聊那只鴨子本身值不值得買(mǎi)而是借此把“網(wǎng)紅爆款里的電機(jī)復(fù)刻”這件事講透。核心內(nèi)容分為幾塊爆款產(chǎn)品里用的電機(jī)到底是什么類(lèi)型為什么它比普通直流電機(jī)難復(fù)刻復(fù)刻的成本到底高在哪里如果你真想動(dòng)手從電機(jī)選型到驅(qū)動(dòng)板設(shè)計(jì)再到控制算法完整的技術(shù)路徑應(yīng)該怎么走。讀完之后你會(huì)得到一份能夠直接指導(dǎo)實(shí)踐的電機(jī)復(fù)刻技術(shù)地圖包括硬件選型、FOC 控制原理、三環(huán)調(diào)試順序、常見(jiàn)坑和排查思路。不管你是想做個(gè)機(jī)械臂關(guān)節(jié)、小車(chē)底盤(pán)還是純粹想搞懂爆款產(chǎn)品背后的動(dòng)力系統(tǒng)這篇文章都值得收藏。1. 這篇文章真正要解決的問(wèn)題先直接給結(jié)論爆款玩具鴨的核心技術(shù)含量不在外觀而在動(dòng)力系統(tǒng)。它要在受限的體積、成本、電池容量下實(shí)現(xiàn)穩(wěn)定行走、轉(zhuǎn)向、姿態(tài)糾正這不是一個(gè)普通 TT 馬達(dá)加兩個(gè)輪子就能搞定的方案。復(fù)刻它的難點(diǎn)也不在 3D 打印外殼而在三個(gè)維度電機(jī)選型什么樣的電機(jī)能在小體積下給出足夠扭矩同時(shí)續(xù)航還能撐住。驅(qū)動(dòng)方案是選有刷直流電機(jī)加 H 橋還是無(wú)刷電機(jī)加 FOC 控制器?？刂崎]環(huán)行走時(shí)的PID參數(shù)調(diào)校、堵轉(zhuǎn)保護(hù)、電池電壓跌落補(bǔ)償這些才是調(diào)試時(shí)間的大頭。所以這篇文章真正要解決的不是“怎么把鴨子抄出來(lái)賣(mài)”而是當(dāng)你看到一個(gè)爆款硬件產(chǎn)品時(shí)怎么用電機(jī)控制的知識(shí)拆解它并且實(shí)際動(dòng)手做出一個(gè)能跑的控制系統(tǒng)。對(duì)于正在學(xué) STM32 電機(jī)控制、BLDC 驅(qū)動(dòng)、FOC 算法的嵌入式開(kāi)發(fā)者來(lái)說(shuō)這是一篇把概念、選型、代碼、調(diào)試串起來(lái)的實(shí)戰(zhàn)向文章。2. 爆款玩具鴨的電機(jī)到底是什么類(lèi)型從材料看這類(lèi)產(chǎn)品選用的核心動(dòng)力是小尺寸空心杯電機(jī)或微型無(wú)刷減速電機(jī)配合行星齒輪減速箱輸出扭矩。它和我們常見(jiàn)的 130 電機(jī)、TT 馬達(dá)有一個(gè)本質(zhì)區(qū)別自帶減速機(jī)構(gòu)輸出的是低速大扭矩。2.1 為什么需要減速箱玩具鴨行走時(shí)輪子轉(zhuǎn)速其實(shí)不高但需要克服地面摩擦和自身重量。如果直接用高速電機(jī)帶動(dòng)輪子扭矩不夠起步困難轉(zhuǎn)向時(shí)還會(huì)打滑。普通玩具常見(jiàn)做法是高速電機(jī)加減速齒輪常見(jiàn)減速比從 10:1 到 30:1。扭矩通過(guò)減速比放大但代價(jià)是轉(zhuǎn)速下降、整體效率下降、噪音上升。爆款鴨這類(lèi)產(chǎn)品通常使用定制減速箱減速比經(jīng)過(guò)仔細(xì)計(jì)算保證一輪電池能持續(xù)行走幾百米。2.2 無(wú)刷還是有刷這是復(fù)刻時(shí)最容易糾結(jié)的問(wèn)題。電機(jī)類(lèi)型優(yōu)點(diǎn)缺點(diǎn)適用場(chǎng)景有刷直流電機(jī)驅(qū)動(dòng)簡(jiǎn)單、控制成熟、成本低碳刷磨損、噪音大、效率低普通玩具、簡(jiǎn)單小車(chē)空心杯有刷電機(jī)慣量小、響應(yīng)快、體積小成本略高、仍存在機(jī)械換向高端玩具、航模舵機(jī)無(wú)刷直流電機(jī) BLDC壽命長(zhǎng)、效率高、噪音低驅(qū)動(dòng)復(fù)雜、需要 FOC 或方波控制無(wú)人機(jī)、機(jī)器人、高端產(chǎn)品從爆款產(chǎn)品的壽命、靜音和續(xù)航要求來(lái)看無(wú)刷方案更符合產(chǎn)品定位。但對(duì)于想快速?gòu)?fù)刻原型驗(yàn)證的開(kāi)發(fā)者先用有刷電機(jī)加編碼器跑通閉環(huán)再替換成無(wú)刷方案才是更穩(wěn)的工程路徑。這里要糾正一個(gè)常見(jiàn)誤區(qū)**無(wú)刷電機(jī)不一定是更高級(jí)的選擇它在低速大扭矩場(chǎng)景下對(duì)控制算法要求很高。**方波控制噪音大、頓挫感明顯FOC 控制效果好但調(diào)試門(mén)檻高。新手第一次做無(wú)刷項(xiàng)目很容易卡在換向時(shí)序上。3. 復(fù)刻一只鴨子為什么比買(mǎi)成品還貴這個(gè)問(wèn)題很有討論價(jià)值因?yàn)樗┞读撕芏嘤布_(kāi)發(fā)者的認(rèn)知盲區(qū)。看起來(lái)一只鴨子賣(mài)幾十塊里面電機(jī)成本可能只有幾塊錢(qián)到十幾塊錢(qián)。自己去買(mǎi)電機(jī)、減速箱、輪子、驅(qū)動(dòng)板、電池、外殼單件成本加起來(lái)好像也不高。但實(shí)際上真實(shí)成本分布是這樣的3.1 BOM 成本不是全部從材料看個(gè)人復(fù)刻時(shí)容易忽略的成本包括打樣成本3D 打印一個(gè)外殼加結(jié)構(gòu)件材料費(fèi)不高但反復(fù)迭代修改的機(jī)時(shí)成本很高。采購(gòu)零散化成本個(gè)人買(mǎi)電機(jī)是零售價(jià)工廠用的是批量?jī)r(jià)差價(jià)通常有 3 到 5 倍。調(diào)試時(shí)間成本PID 參數(shù)整定、機(jī)械結(jié)構(gòu)干涉、電池電壓跌落導(dǎo)致的電機(jī)非線(xiàn)性表現(xiàn)這些都是隱形消耗。模具與工藝成本量產(chǎn)外殼是注塑工藝一次模具費(fèi)可能上萬(wàn)但分?jǐn)偟綆兹f(wàn)個(gè)產(chǎn)品上就很低。3.2 核心技術(shù)在控制不在零件爆款鴨能穩(wěn)定走直線(xiàn)背后可能不是重力回正而是編碼器加 PID 閉環(huán)或者機(jī)械限位結(jié)構(gòu)。抄外殼容易抄控制邏輯難。舉個(gè)我們?cè)跈C(jī)器人關(guān)節(jié)里常見(jiàn)的例子同一個(gè)電機(jī)配上不同的減速比和控制算法做出來(lái)的運(yùn)動(dòng)性能天差地別。有人用 6020 電機(jī)做機(jī)械臂關(guān)節(jié)有人用 3508 電機(jī)配好好減速比最終效果完全不同。所以復(fù)刻比買(mǎi)貴的本質(zhì)是你在為“可靠性和穩(wěn)定性”付錢(qián)不是為“零件”付錢(qián)。4. 電機(jī)復(fù)刻的最小技術(shù)路徑如果你看完上面的成本分析還是決定動(dòng)手復(fù)刻一套動(dòng)力系統(tǒng)來(lái)學(xué)習(xí)下面這條技術(shù)路徑可以作為起點(diǎn)。4.1 第一步明確運(yùn)動(dòng)需求先列出你希望最終產(chǎn)品具備的運(yùn)動(dòng)參數(shù)整車(chē)或整機(jī)重量。最大速度。最大爬坡角度。電池電壓和容量。續(xù)航時(shí)間。這些參數(shù)直接決定電機(jī)功率和減速比。一個(gè)粗略估算公式所需扭矩 T (整車(chē)重量 × 重力加速度 × 滾動(dòng)摩擦系數(shù)) × 輪子半徑假設(shè)整車(chē)重量 500g摩擦系數(shù) 0.15輪子半徑 30mmweight 0.5 # kg g 9.8 mu 0.15 wheel_radius 0.03 # m torque weight * g * mu * wheel_radius print(f所需扭矩約 {torque:.3f} N·m)輸出所需扭矩約 0.022 N·m這個(gè)扭矩看起來(lái)很小但注意這只是勻速運(yùn)動(dòng)下的扭矩。起步加速、上坡、越過(guò)障礙都需要額外余量通常要乘以 2 到 3 倍的安全系數(shù)。4.2 第二步選擇電機(jī)類(lèi)型建議從下面這條決策路徑走如果想快速跑通原型、先驗(yàn)證控制邏輯建議使用帶編碼器的有刷直流電機(jī)如常見(jiàn)的 GA12-N20 減速電機(jī)。它自帶減速箱和霍爾編碼器控制方便驅(qū)動(dòng)芯片便宜。如果目標(biāo)是學(xué)習(xí) BLDC 和 FOC建議選擇云臺(tái)電機(jī)、航模電機(jī)或機(jī)器人關(guān)節(jié)電機(jī)比如常見(jiàn)的大疆 3508、M2006或國(guó)產(chǎn) 6020 電機(jī)。這類(lèi)電機(jī)扭矩密度高但必須搭配對(duì)應(yīng)驅(qū)動(dòng)器和上位機(jī)才能工作。如果是純學(xué)習(xí)電機(jī)控制原理不追求實(shí)際產(chǎn)品效果可以直接用 Gimbal 電機(jī)自己搭 FOC 驅(qū)動(dòng)板使用 STM32G4 系列 MCU配合三電阻采樣方案。4.3 第三步設(shè)計(jì)驅(qū)動(dòng)方案有刷電機(jī)驅(qū)動(dòng)相對(duì)簡(jiǎn)單使用 PWM 加 H 橋即可。無(wú)刷電機(jī)需要設(shè)計(jì)三相逆變電橋和轉(zhuǎn)子位置檢測(cè)電路。這是兩類(lèi)方案的核心差異對(duì)比項(xiàng)有刷直流電機(jī)無(wú)刷直流電機(jī)驅(qū)動(dòng)電路H 橋或雙 H 橋三相全橋逆變器換向方式機(jī)械換向電子換向轉(zhuǎn)子位置檢測(cè)編碼器可選霍爾傳感器或反電動(dòng)勢(shì)檢測(cè)控制算法單環(huán) PID 即可方波換向或 FOC開(kāi)發(fā)難度低高新手容易忽略的一點(diǎn)是**無(wú)刷電機(jī)必須知道轉(zhuǎn)子當(dāng)前位置才能決定先給哪兩相通電。**如果你用反電動(dòng)勢(shì)過(guò)零檢測(cè)BEMF需要考慮電機(jī)轉(zhuǎn)速和反電動(dòng)勢(shì)幅值成正比的問(wèn)題低速啟動(dòng)時(shí)會(huì)非常難處理。所以實(shí)際項(xiàng)目中位置檢測(cè)方式先選帶霍爾傳感器的電機(jī)不要一上來(lái)就玩無(wú)感 FOC。5. 從零搭一套電機(jī)控制 Demo下面我們用 STM32 平臺(tái)搭一套最簡(jiǎn)單的有刷直流電機(jī) PID 速度閉環(huán)再加上編碼器反饋。這套方案雖然不涉及無(wú)刷電機(jī)但它是理解無(wú)刷電機(jī)三環(huán)控制的基礎(chǔ)。5.1 硬件清單STM32F407ZGT6 開(kāi)發(fā)板。GB37Y3530 直流減速電機(jī)帶 AB 相霍爾編碼器。L298N 或 TB6612 電機(jī)驅(qū)動(dòng)模塊。12V 鋰電池或直流電源。USB-TTL 串口模塊。這里重點(diǎn)說(shuō)一下驅(qū)動(dòng)模塊的選擇。L298N 經(jīng)典但壓降大在電池供電場(chǎng)景下效率不理想TB6612 屬于 H 橋驅(qū)動(dòng)導(dǎo)通電阻小適合中小功率直流電機(jī)。從材料看很多初學(xué)者做 STM32 控制 3508、TB6612 驅(qū)動(dòng)選型最終卡在供電不穩(wěn)上。這里提醒一點(diǎn)電機(jī)驅(qū)動(dòng)模塊的電源和 MCU 電源必須隔離或至少共地但不要互相干擾否則容易導(dǎo)致單片機(jī)復(fù)位的詭異 Bug。5.2 初始化定時(shí)器編碼器模式我們使用定時(shí)器 3 的編碼器模式讀取電機(jī) AB 相。// 文件路徑Src/tim.c void MX_TIM3_Init_Encoder(void) { GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_TIM3_CLK_ENABLE(); __HAL_RCC_GPIOA_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6 | GPIO_PIN_7; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM3; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); htim3.Instance TIM3; htim3.Init.Prescaler 0; htim3.Init.CounterMode TIM_COUNTERMODE_UP; htim3.Init.Period 65535; htim3.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; htim3.Init.AutoReloadPreload TIM_AUTORELOAD_PRELOAD_DISABLE; HAL_TIM_Encoder_Init(htim3); HAL_TIM_Encoder_Start(htim3, TIM_CHANNEL_ALL); }這里關(guān)鍵點(diǎn)在于編碼器模式使用兩個(gè)通道輸入自動(dòng)根據(jù) AB 相位差判斷旋轉(zhuǎn)方向。計(jì)數(shù)器是 16 位的計(jì)數(shù)超過(guò) 65535 會(huì)溢出回繞需要在軟件里做溢出補(bǔ)償。GPIO 必須配置為復(fù)用推挽模式否則讀不到脈沖。5.3 電機(jī) PWM 輸出我們使用定時(shí)器 4 通道 1 輸出 PWM 控制電機(jī)轉(zhuǎn)速。// 文件路徑Src/motor.c #include motor.h void Motor_Init(void) { GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_TIM4_CLK_ENABLE(); __HAL_RCC_GPIOB_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM4; HAL_GPIO_Init(GPIOB, GPIO_InitStruct); htim4.Instance TIM4; htim4.Init.Prescaler 84 - 1; htim4.Init.CounterMode TIM_COUNTERMODE_UP; htim4.Init.Period 1000 - 1; htim4.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; HAL_TIM_PWM_Init(htim4); TIM_OC_InitTypeDef sConfigOC {0}; sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 0; sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(htim4, sConfigOC, TIM_CHANNEL_1); HAL_TIM_PWM_Start(htim4, TIM_CHANNEL_1); } void Motor_SetSpeed(int16_t speed) { if (speed 0) { // 正轉(zhuǎn)方向設(shè)置引腳 HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_RESET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, speed); } else if (speed 0) { HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, -speed); } else { HAL_GPIO_WritePin(MOTOR_IN1_GPIO_Port, MOTOR_IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(MOTOR_IN2_GPIO_Port, MOTOR_IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(htim4, TIM_CHANNEL_1, 0); } }這里的 PWM 頻率是 84MHz 除以 84預(yù)分頻再除以 1000自動(dòng)重裝載大約 1kHz。**電機(jī)驅(qū)動(dòng)的 PWM 頻率通常選 10kHz 到 20kHz 更合適可以減少電流紋波和電磁噪音。**上面的寫(xiě)法只是為了演示實(shí)際項(xiàng)目建議把 Period 改成 4200得到 20kHz。5.4 速度閉環(huán) PID速度環(huán)需要實(shí)時(shí)讀取編碼器計(jì)數(shù)并轉(zhuǎn)換成轉(zhuǎn)速值。// 文件路徑Src/pid.c typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; } PID_t; void PID_Init(PID_t *pid, float kp, float ki, float kd) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-integral 0; pid-prev_error 0; } float PID_Update(PID_t *pid, float target, float current) { float error target - current; pid-integral error; float derivative error - pid-prev_error; pid-prev_error error; return pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; }調(diào)用邏輯一般是// 文件路徑Src/main.c int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_TIM3_Init_Encoder(); Motor_Init(); PID_t speed_pid; PID_Init(speed_pid, 0.3f, 0.05f, 0.0f); int16_t target_speed 200; // 目標(biāo)轉(zhuǎn)速編碼器計(jì)數(shù)差值 while (1) { int16_t current_speed TIM3-CNT - last_count; last_count TIM3-CNT; int16_t pwm_output PID_Update(speed_pid, target_speed, current_speed); Motor_SetSpeed(pwm_output); HAL_Delay(10); } }注意這個(gè)速度環(huán)只是最小演示。實(shí)際項(xiàng)目里應(yīng)該在定時(shí)器中斷里做固定頻率的 PID 計(jì)算而不是在 while 循環(huán)里用 HAL_Delay因?yàn)?HAL_Delay 的不確定性會(huì)影響 PID 采樣周期導(dǎo)致控制不穩(wěn)定。6. 進(jìn)階BLDC 電機(jī)與 FOC 控制如果你已經(jīng)跑通有刷閉環(huán)下一步就可以轉(zhuǎn)向無(wú)刷電機(jī)和 FOC這也是機(jī)器人關(guān)節(jié)、無(wú)人機(jī)、爆款無(wú)刷玩具里最常見(jiàn)的技術(shù)路線(xiàn)。6.1 FOC 在解決什么問(wèn)題有刷電機(jī)通過(guò)改變 PWM 占空比可以直接控制兩端電壓控制量是標(biāo)量。無(wú)刷電機(jī)的三相繞組需要按轉(zhuǎn)子位置同步換向控制目標(biāo)是讓定子磁場(chǎng)始終和轉(zhuǎn)子磁場(chǎng)保持 90 度相位差這樣才能輸出最大扭矩。FOC磁場(chǎng)定向控制的核心思想是把三相電流通過(guò) Clarke 變換和 Park 變換從靜止坐標(biāo)系轉(zhuǎn)換到轉(zhuǎn)子同步旋轉(zhuǎn)坐標(biāo)系讓電流環(huán)可以像控制直流電機(jī)一樣控制交軸電流 Iq 和直軸電流 Id。其中Iq 控制扭矩輸出。Id 通常控制在 0避免削弱磁場(chǎng)。電流環(huán)需要高速執(zhí)行典型頻率是 10kHz 到 20kHz。速度環(huán)和位置環(huán)在電流環(huán)上層典型頻率是 1kHz 左右。6.2 硬件方案從材料看STM32G4 系列是當(dāng)前做電機(jī)控制的性?xún)r(jià)比選擇。它內(nèi)置了適合電機(jī)控制的外設(shè)高精度定時(shí)器 HRTIM、運(yùn)算放大器、比較器、ADC 硬件過(guò)采樣。常見(jiàn)驅(qū)動(dòng)方案功率管FD6288T 或 EG2134 等三相柵極驅(qū)動(dòng)芯片。MOS 管根據(jù)電機(jī)電流選擇常見(jiàn) 40V/30A 規(guī)格。采樣方式三電阻采樣或單電阻采樣。編碼器磁編碼器或光電編碼器常用 AS5600、MT6701。6.3 電流環(huán)代碼結(jié)構(gòu)FOC 代碼通常包含// 文件路徑Src/foc.c float clamp_val(float value, float max_val) { return (value max_val) ? max_val : (value -max_val) ? -max_val : value; } void FOC_CurrentLoop(float target_iq, float target_id, float i_alpha, float i_beta, float theta_elec) { // Park 變換 float i_d i_alpha * cosf(theta_elec) i_beta * sinf(theta_elec); float i_q -i_alpha * sinf(theta_elec) i_beta * cosf(theta_elec); // PI 調(diào)節(jié)器 float v_d PID_Update(pid_d, target_id, i_d); float v_q PID_Update(pid_q, target_iq, i_q); // 反 Park 變換 float v_alpha v_d * cosf(theta_elec) - v_q * sinf(theta_elec); float v_beta v_d * sinf(theta_elec) v_q * cosf(theta_elec); // SVPWM 調(diào)制輸出 SVPWM_Update(v_alpha, v_beta); }這段代碼是 FOC 電流環(huán)的最小骨架。對(duì)于新手最重要的不是背公式而是先理解每個(gè)變量在物理上對(duì)應(yīng)什么。7. 電機(jī)控制常見(jiàn)問(wèn)題與排查思路無(wú)論有刷還是無(wú)刷調(diào)試中最常見(jiàn)的問(wèn)題集中在電源、換向、反饋三大塊。問(wèn)題現(xiàn)象可能原因排查方式解決方案電機(jī)不轉(zhuǎn)驅(qū)動(dòng)板供電不足用萬(wàn)用表測(cè)電機(jī)端電壓、PWM 輸出單獨(dú)給電機(jī)供電確認(rèn)共地電機(jī)抖動(dòng)編碼器 AB 相接反檢查編碼器線(xiàn)序查看計(jì)數(shù)方向交換 A、B 相或調(diào)整計(jì)數(shù)方向PID 速度震蕩Kp 過(guò)大、Ki 過(guò)大減小 KpKi 先設(shè) 0觀察響應(yīng)曲線(xiàn)先調(diào) Kp 找到臨界再加 Ki 消除穩(wěn)態(tài)誤差電機(jī)正反轉(zhuǎn)不均勻換向邏輯有誤輸出固定 PWM觀察轉(zhuǎn)向和方向引腳電平關(guān)系統(tǒng)一電機(jī)方向定義前端校準(zhǔn)BLDC 無(wú)法啟動(dòng)無(wú)感方波啟動(dòng)電流不足提升啟動(dòng) PWM 占空比確認(rèn)換向順序改用帶霍爾傳感器的電機(jī)FOC 電流采樣噪聲大采樣時(shí)機(jī)和 PWM 占空比重合檢查 ADC 采樣觸發(fā)點(diǎn)使用中心對(duì)齊 PWM在計(jì)數(shù)器歸零時(shí)采樣電機(jī)發(fā)熱嚴(yán)重PWM 頻率過(guò)低或采樣電阻功率不足測(cè) PWM 頻率和相電流波形提高 PWM 頻率至 20kHz 左右單片機(jī)復(fù)位電機(jī)反電動(dòng)勢(shì)干擾電源示波器抓 MCU 供電紋波增加電源去耦電容分路供電8. 最佳實(shí)踐與工程建議電機(jī)控制項(xiàng)目里最容易拉低進(jìn)度的不是算法本身而是工程習(xí)慣。8.1 硬件設(shè)計(jì)建議電機(jī)驅(qū)動(dòng)部分和主控部分分開(kāi)供電至少分開(kāi)走線(xiàn)最后單點(diǎn)共地。在電機(jī)供電入口加一個(gè)大容量電解電容和陶瓷電容吸收反電動(dòng)勢(shì)尖峰。編碼器信號(hào)線(xiàn)走短使用雙絞線(xiàn)或屏蔽線(xiàn)避免和 PWM 線(xiàn)平行。采樣電阻選低電感類(lèi)型比如合金電阻采樣電壓信號(hào)經(jīng)過(guò) RC 濾波后再進(jìn) ADC。8.2 軟件設(shè)計(jì)建議所有 PID 參數(shù)保存到 Flash 或配置文件不要硬編碼在源碼里。調(diào)試階段使用串口或 USB 虛擬串口輸出實(shí)時(shí)轉(zhuǎn)速、電流、目標(biāo)值方便畫(huà)曲線(xiàn)?？刂浦芷诒仨氂枚〞r(shí)器中斷觸發(fā)不要在 while 循環(huán)里依賴(lài)流水線(xiàn)執(zhí)行時(shí)間。在電流環(huán)內(nèi)部不要做浮點(diǎn)打印操作浮點(diǎn)運(yùn)算和串口輸出會(huì)占用大量時(shí)間。加入限幅PWM 輸出和 PI 積分項(xiàng)都要限幅防止啟動(dòng)瞬間積分飽和導(dǎo)致超調(diào)失控。8.3 安全與測(cè)試建議任何電機(jī)上電測(cè)試前確認(rèn)機(jī)械機(jī)構(gòu)沒(méi)有卡住避免堵轉(zhuǎn)電流燒毀驅(qū)動(dòng)器。第一次通電時(shí)使用限流電源把電流限制在額定電流的 50% 以下。無(wú)刷電機(jī)換向錯(cuò)誤會(huì)導(dǎo)致過(guò)流務(wù)必在代碼中實(shí)現(xiàn)過(guò)流保護(hù)邏輯。如果要控制一號(hào)機(jī)器人關(guān)節(jié)或 3508 這類(lèi)高扭矩電機(jī)啟動(dòng)前先把目標(biāo)值設(shè)為零然后手動(dòng)緩慢增加。8.4 參數(shù)內(nèi)部處理建議引力爆款產(chǎn)品里見(jiàn)的電機(jī)參數(shù)比如扭矩、轉(zhuǎn)速、減速比很多來(lái)自廠家手冊(cè)。但實(shí)際上電機(jī)的空載轉(zhuǎn)速、堵轉(zhuǎn)扭矩和額定扭矩之間是非線(xiàn)性關(guān)系電機(jī)實(shí)際表現(xiàn)還會(huì)隨電池電壓跌落而變化。更穩(wěn)妥的做法是在樣機(jī)上做一組實(shí)測(cè)空載轉(zhuǎn)速用碼盤(pán)或示波器測(cè)出霍爾頻率換算。堵轉(zhuǎn)電流用鉗形表測(cè)電機(jī)短路狀態(tài)下的電流。不同電壓下的轉(zhuǎn)速-扭矩曲線(xiàn)至少測(cè) 7.4V、11.1V、12V 三組。只有拿到這些實(shí)測(cè)數(shù)據(jù)PID 參數(shù)才有意義否則全靠猜。9. 總結(jié)與后續(xù)學(xué)習(xí)方向回到開(kāi)頭的問(wèn)題復(fù)刻一只 4 秒賣(mài)出的爆款鴨為什么比直接買(mǎi)還貴從電機(jī)控制的角度看答案很明確爆款產(chǎn)品真正的護(hù)城河是產(chǎn)品定義能力和工程調(diào)優(yōu)能力。電機(jī)選型、減速比計(jì)算、控制算法、結(jié)構(gòu)與運(yùn)動(dòng)的配合每一項(xiàng)都需要大量試錯(cuò)沉淀。個(gè)人復(fù)刻要付出時(shí)間和試錯(cuò)成本而量產(chǎn)工廠把這些成本分散到了幾十萬(wàn)個(gè)訂單上。對(duì)于想要學(xué)習(xí)電機(jī)控制的開(kāi)發(fā)者最值得投入的方向是把有刷電機(jī)的 PID 速度環(huán)和位置環(huán)跑順再進(jìn)入 BLDC 的方波控制和 FOC 控制然后重點(diǎn)研究電機(jī)三環(huán)控制架構(gòu)里的電流環(huán)、速度環(huán)、位置環(huán)的時(shí)序關(guān)系。硬件上可以用 STM32G4 加三相驅(qū)動(dòng)板自研一套低成本 FOC 驅(qū)動(dòng)配合 AS5600 磁編碼器調(diào)試。從材料看STM32G4、3508、TB6612、6020 這類(lèi)關(guān)鍵詞在電機(jī)控制社區(qū)里高頻出現(xiàn)說(shuō)明這是一整套成熟的學(xué)習(xí)路徑。與其糾結(jié)怎么復(fù)刻別人已經(jīng)量產(chǎn)的爆款不如從拆解它的需求出發(fā)做一個(gè)屬于你自己的“電機(jī)控制小樣機(jī)”。什么時(shí)候你能用自己的驅(qū)動(dòng)板把電機(jī)從參數(shù)配置到閉環(huán)調(diào)試完整跑通你就真正摸到了爆款產(chǎn)品背后那塊最核心的技術(shù)底座。