AN53: TMC4671 PI Tuning

Document Revision V1.2.2 - 2020-Feb-05

本文逐步介如何使用USB-2-RTMI（RTMI）一步一步調(diào)試TMC4671。通訊轉(zhuǎn)換器是采用基于FTDFT4222H高速USB轉(zhuǎn)SPI橋路。采用USB供電帶有一個小巧的10引腳接頭和和TMC4671-EVAL的RTMI接口引腳相同，且具有相同的引分配可以在TMC4671估板上找到。TMCL-IDE提供軟件工具用于調(diào)試不同控制環(huán)路。因此，RTMI是調(diào)試、監(jiān)控和系統(tǒng)配置的最簡便的方。

1 Items used

• 直流無刷伺服電機(jī), (e.g. QBL4208-61-04-013-1024-AT)
• TMC4671-EVAL-Kit
• USB-2-RTMI
• TMCL-IDE (3.0.24)
• 電源(24V)
• Micro-USB通訊線纜
• Mini-USB通訊線纜
  

  

2 USB-2-RTMI Driver Installation

參考 USB-2-RTMI指南 完成驅(qū)動安裝。

3 Basic Configuration

在使用調(diào)試工具之前，必須先配置 TMC4671（例如，使用TMC4671 Wizard）。

在完成基本的參數(shù)配置之后，可以保存為C代碼或.tpc腳本

?

• 在摘要中 （Summary） 選擇ABN編碼器
• 使用Export Script 導(dǎo)出腳本

4 Tuning

4.1 Overview

TMC4671支持三種主要的操作模式，它們需要進(jìn)行PI配置：

• current/torque mode - 電流/力矩模式
• velocity mode - 速度模式
• position mode - 位置模式
  每個模式都可以通過PI對每個環(huán)路進(jìn)行調(diào)試。如下圖概述：
  

  

  
  這是一個串聯(lián)的環(huán)路，因此外環(huán)依賴內(nèi)環(huán)的調(diào)優(yōu)。例如，在使用速度環(huán)之前必須先配置電流環(huán)。為每個 PI 控制器的調(diào)整提供了軟件工具。在TMCL-IDE中，可以通過 Tuning Group 訪問這些調(diào)試工具 調(diào)整工具包括：
• Biquad tuning: 用于過率每個循環(huán)的目標(biāo)值
• Torque/Flux tuning: 通過開環(huán)階躍響應(yīng)識別PI參數(shù)
• Step response: 適應(yīng)所有控制回路的閉環(huán)階躍響應(yīng)
• Bode plot: 所有環(huán)路的波特圖
• IC scope: 監(jiān)控，讀出寄存器值與PWM頻率

4.2 Limits

• 在使用調(diào)試工具之前，建議將輸出電壓設(shè)置為最大 （設(shè)置 PIDOUT_UQ_UD_LIMITS = 32767 置）。 對于
  步進(jìn)來說默認(rèn)值就可以了。
• 將 PID_TORQUE_FLUX_LIMITS 設(shè)置為應(yīng)用中所允許的最大電流數(shù)值。
• 設(shè)置 PID_POSITION_LIMIT_HIGH = 2 147400 000
• 設(shè)置 PID_POSITION_LIMIT_LOW = -2 147400 000
  

  

5 Tuning of the current loop

電流環(huán)由兩個控制環(huán)路組成：一用于扭矩（電流），另一用于磁通（電流）。都可以使用 RTMI 工具在 TorqueFlux / Tuning 工具 和 Step response 工具調(diào)整。Torque轉(zhuǎn)矩/Flux磁通工具在開環(huán)模式下確定PI參數(shù)。

5.1 Torque/Flux Tuning Tool (Open Loop)

Torque Flux 調(diào)試工具會通過識別電機(jī)參數(shù)自動確定 PI 參數(shù)的起始值。在此過程中，設(shè)置電壓階躍并評估電流階躍響應(yīng) . 只有磁通量電流被激發(fā)到最小 / 在這個調(diào)整階段沒有運(yùn)動。建議使用 25kHz 的 PWM 頻率以獲得最好的識別結(jié)果.

1. TMC4671-EVAL連接到RTMI和PC。

2. 打開 “Torque/Flux Tuning Tool”。

3. 單擊 “Start”按鈕開始整定

4. 給出了電流對電壓階躍的響應(yīng)，以及系統(tǒng)的辨識結(jié)果

   

   

5. 檢查和手動調(diào)整Y范圍，以獲得更好的視圖

6. 單擊“Start”按鈕重新識別系統(tǒng)，如果電機(jī)匹配一致，將會給出更好的識別結(jié)果

7. 如果需要，調(diào)整所需要的電腦顯示窗口。在大多數(shù)情況下，默認(rèn)設(shè)置將提供良好的結(jié)果。 - 動態(tài)階躍響應(yīng)被涵蓋在識別區(qū)（虛線框內(nèi)）：

   • 動態(tài)階躍響應(yīng)應(yīng)覆蓋在識別區(qū)域（虛線框）中

     

     

   • 在圖 11 階躍響應(yīng)沒有完全涵蓋.識別區(qū)域太小。

     

   • 在圖 12 中，標(biāo)識區(qū)域太大

     

8. 將識別出的PI值寫入當(dāng)前控制器

   • 使用以下按鈕將 PI 值更新到電流控制器
     

     

   • 注意 : 對于非常高的值標(biāo)識 I-parameter 顯示為 0. 在這種情況下，需要手動設(shè)置 I 參數(shù) ( 如 . 設(shè)置18000)。
   • 用PI控制框確認(rèn)新的 PI 值.必須使用 Reload 按鈕更新值。
     

     

5.2 Step Response Toolbox (Closed Loop)

在前一步中，力矩 / 磁通電流環(huán)的 PI 參數(shù)是在開環(huán)模式下被識別到的 . 現(xiàn)在，階躍響應(yīng)工具將用于分析閉環(huán)行
為。

1. 打開 Step response toolbox
   

   

2. 配置電流控制的磁通電流設(shè)置
   • 目標(biāo)值/Target value: 0x64 PID_FLUX_TARGET
   • 測量值/Measurement 1: 0x69 PID_FLUX_ACTUAL
   • 采樣頻率/Sampling rate: PWM
   • 下一步驟
     ? 設(shè)置 Start value = 0
     ? 確定最終的磁通量 flux target current 目標(biāo)值(這里數(shù)值4000)
   • 使用 Start 按鈕啟動階躍響應(yīng)step response
3. 實際電流和目標(biāo)電流顯示出來
   

   

4. 降低采樣率以獲得更好的效果
   

   

5. 通過修改不同的 P 和 I 優(yōu)化性能
6. 從步驟 2 開始重復(fù)，修改 PID_TORQUE_TARGET, PID_TORQUE_ACTUAL。

5.3 Bode Plot

波特圖工具用于確認(rèn)電流環(huán)動態(tài)性能。

1. 打開 Bode Plot

2. 選擇 1: torque control loop

3. 開始 measurement 通過單擊 Start 按鈕 (其他設(shè)置保持默認(rèn)值)

4. 對比的例子: 下面 2 個測量顯示調(diào)節(jié)和沒有調(diào)節(jié)使用默認(rèn) PI 參數(shù)下的波特圖.

5. 默認(rèn) PI 數(shù)

   

   

6. 調(diào)整 PI 參數(shù)

   

   

7. 調(diào)諧PI后的控制系統(tǒng)具有較高的截止頻率，因此具有較高的動態(tài)性能

   

6 Tuning of the velocity loop

這個章節(jié)介紹速度環(huán)調(diào)節(jié) . 前提條件是電流環(huán)已經(jīng)被調(diào)節(jié)完成。為了調(diào)整速度環(huán) PI 參數(shù)，請使用 step response tool (closed loop) 閉環(huán)階躍響應(yīng)工具

1. 為了方便速度單位確認(rèn) . 在 Selectorstoolbox 里的 VELOCITY_SELECTION （ 0x52 ）需要從 phi_e_selection 設(shè)置為 phi_m_abn。
   • phi_m: 機(jī)械速度顯示和計算的單位是RPM（每分鐘轉(zhuǎn)數(shù)）
   • phi_e: 電氣速度顯示和計算的單位是電周期
2. 設(shè)置速度環(huán)的 PI 參數(shù)
   開始時設(shè)置一個比較低的 P數(shù)值; set I = 0

• 0x58: PID_VELOCITY_I = 0
• 0x58: PID_VELOCITY_P = 100
  

  

1. 打開 Step Response tool box

2. 使用階躍響應(yīng)的實例配置

3. 單擊 Start 按鈕開始階躍響應(yīng)

   

4. 逐漸增加 PID_VELOCITY_P， 直到實際速度 （PID_VELOCITY_ACTUAL）達(dá)到 50-75%
   目標(biāo)速度 （PID_VELOCITY_TARGET）

   

   

5. 增加PID_VELOCIT_I 數(shù)值直到實際速度達(dá)到目標(biāo)速度

   

   

7 Tuning of the position loop

本章節(jié)介紹位置環(huán)調(diào)試，在使用位置環(huán)之前 電流環(huán)和速度環(huán)需要先被配置好，使用階躍響應(yīng)工具來調(diào)試，然后
使用開發(fā)板套裝的MCU板 Landungsbruecke 用于提升動態(tài)性能和精度。

7.1 Step Response Tool

1. 將 POSITION_SELECTION 設(shè)置為 phi_m_abn
   因此電機(jī)的一圈脈沖數(shù)為 65535 counts

2. 設(shè)置 PI 位置控制器的初始值

   • PID_POSITION_I = 0 (對于大多數(shù)設(shè)置，建議將此設(shè)置為0)
   • PID_POSITION_P = 10
     

     

3. 打開 step response tool

4. 單擊 Start 按鈕開始階躍響應(yīng)。電機(jī)會以 end value 值來回運(yùn)動. 這里是 1 轉(zhuǎn)

5. PID_POSITION_P = 10 時電機(jī)不運(yùn)動。

   

6. 增加比列數(shù)值P: PID_POSITION_P = 50

   

7. 增大比例參數(shù) P 值: PID_POSITION_P = 100

   

8. 調(diào)整后的 PI 配置。

   

7.2 Motion Controller

開發(fā)板套裝上的 MUC 板 Landungsbrücke 帶有梯形坡型發(fā)生器可以和 TMC4671-EVAL 一起使用。 TMC4671 芯片
并不集成運(yùn)動控制功能.

1.?通過?Mini?USB?將MUC板?Landungsbruecke?連接到電腦

? 2. 在 Landungsbruecke 對話框 （USB-2-RTMI不可用) 中打開位置模式工具b箱
? 3. 使能速度控制曲線和加速度限制

4. 在位置控制工具框 position mode toolbox 控制電機(jī)轉(zhuǎn) 10 圈

   • 清零位置數(shù)值 Clear the position
   • 設(shè)置目標(biāo)位置 Target pos. = 655350
   • 單擊 absolute 按鈕開始電機(jī)運(yùn)動
     

     

5. 增大減速度

   

6. 用運(yùn)動控制重復(fù) 10 圈 同時增大減速度參數(shù), 也可以同時調(diào)整PI參數(shù):

   

7. 在增加運(yùn)動控制功能之后調(diào)整 PI 配置

   

8. 通過Export option 選型保存PI配置

   8 Summary

   RTMI 通訊接口為 TMC4671 芯片提供了一個強(qiáng)大的選項來調(diào)試芯片 . 快速實時接入芯片 , 可以用來調(diào)試和監(jiān)控每個環(huán)路。 TMCL-IDE 為系統(tǒng)開發(fā)提供了現(xiàn)成的軟件工具。 關(guān)于更多 TMC4671 和如何使用的問題，請參考TMC4671數(shù)據(jù)表。

   9 Revision History