TWI684319B - 馬達驅動移動平台之控制系統及其控制方法 - Google Patents

馬達驅動移動平台之控制系統及其控制方法 Download PDF

Info

Publication number
TWI684319B
TWI684319B TW108114465A TW108114465A TWI684319B TW I684319 B TWI684319 B TW I684319B TW 108114465 A TW108114465 A TW 108114465A TW 108114465 A TW108114465 A TW 108114465A TW I684319 B TWI684319 B TW I684319B
Authority
TW
Taiwan
Prior art keywords
speed
pwm
mobile platform
drive signal
value
Prior art date
Application number
TW108114465A
Other languages
English (en)
Other versions
TW202040928A (zh
Inventor
林群棋
嘉榮 朱
陳廷碩
Original Assignee
新世代機器人暨人工智慧股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 新世代機器人暨人工智慧股份有限公司 filed Critical 新世代機器人暨人工智慧股份有限公司
Priority to TW108114465A priority Critical patent/TWI684319B/zh
Application granted granted Critical
Publication of TWI684319B publication Critical patent/TWI684319B/zh
Publication of TW202040928A publication Critical patent/TW202040928A/zh

Links

Images

Landscapes

  • Control Of Electric Motors In General (AREA)

Abstract

一種馬達驅動移動平台之控制系統用以控制移動平台之速度。馬達驅動移動平台之控制系統包含減法器、控制器以及信號轉換器。減法器產生誤差速度，控制器產生速度控制信號，信號轉換器產生包含加速驅動信號與減速驅動信號的速度驅動信號。加速驅動信號與減速驅動信號對移動平台提供加、減速控制。

Description

馬達驅動移動平台之控制系統及其控制方法
本發明係有關一種移動平台之控制系統及其控制方法，尤指一種無須額外煞車機構的馬達驅動移動平台之控制系統及其控制方法。
對現有具移動平台的機器人而言，主要係透過馬達驅動的方式對移動平台提供前進的動力。當移動平台需要減速時，則可透過額外的煞車機構主動地施加制動力，對移動平台進行煞車減速。又或者，可利用馬達本身不驅動的方式實現被動減速。藉此，達到移動平台的前進與減速的控制。再者，對於承載不同負載的移動平台欲達到平穩的加、減速控制，則通常以人為方式調整加以控制。
惟前揭方式對現有移動平台進行驅動、控制所存在的問題在於：對採用馬達本身不驅動的方式進行被動減速者，當移動平台的真實速度超過目標速度而需要減速時，則無法實現減速，仍需要依靠額外的煞車機構所提供的制動力才能實現減速。因此，不僅增加設備成本、維護成本，也提高控制的複雜度。再者，透過人為方式對承載不同負載的移動平台進行加、減速控制，將無法達到自動地、即時地、準確地調整控制。
為此，如何設計出一種無須額外煞車機構的馬達驅動移動平台之控制系統及其控制方法，來解決前述的技術問題，乃為本案發明人所研究的重要課題。
本發明之一目的在於解決前揭的技術問題，因此本發明提供一種馬達驅動移動平台之控制系統，用以控制一移動平台之速度。該馬達驅動移動平台之控制系統包含：一減法器、一控制器以及一信號轉換器。該減法器接收一參考速度與一實際速度，且計算該參考速度與該實際速度的差值得到一誤差速度。該控制器接收該誤差速度、該實際速度以及一目標速度的絕對值，且計算出一速度控制信號。該信號轉換器接收該速度控制信號、該實際速度以及該目標速度的絕對值，且計算出一速度驅動信號；其中，該速度驅動信號包含一加速驅動信號與一減速驅動信號。其中，該加速驅動信號與該減速驅動信號對該移動平台提供加、減速控制。
藉由所提出的馬達驅動移動平台之控制系統，能夠無須額外的煞車機構即可實現移動平台的減速，不僅可減少設備成本、維護成本，也降低控制的複雜度，並且採用對馬達速度的閉迴路控制，可達到自動地、即時地、準確地的速度調整與控制。
本發明之另一目的在於解決前揭的技術問題，因此本發明提供一種馬達驅動移動平台之控制方法，用以控制一移動平台之速度。該控制方法包含：(a)、提供一參考速度、一實際速度以及一目標速度的絕對值；(b)、提供一控制器，該控制器根據該參考速度、該實際速度以及該目標速度的絕對值計算 一速度控制信號；(c)、提供一信號轉換器，該信號轉換器根據該速度控制信號、該實際速度以及該目標速度的絕對值計算一速度驅動信號；其中，該速度驅動信號包含一加速驅動信號與一減速驅動信號；以及(d)、根據該加速驅動信號與該減速驅動信號對該移動平台提供加、減速控制。
藉由所提出的馬達驅動移動平台之控制方法，能夠無須額外的煞車機構即可實現移動平台的減速，不僅可減少設備成本、維護成本，也降低控制的複雜度，並且採用對馬達速度的閉迴路控制，可達到自動地、即時地、準確地的速度調整與控制。
為了能更進一步瞭解本發明為達成預定目的所採取之技術、手段及功效，請參閱以下有關本發明之詳細說明與附圖，相信本發明之目的、特徵與特點，當可由此得一深入且具體之瞭解，然而所附圖式僅提供參考與說明用，並非用來對本發明加以限制者。
10‧‧‧控制機制
12‧‧‧減法器
14‧‧‧控制器
16‧‧‧信號轉換器
20‧‧‧移動平台
rk‧‧‧參考速度
ek‧‧‧誤差速度
ck‧‧‧速度控制信號
dk‧‧‧速度驅動信號
yk‧‧‧實際速度
yk+1‧‧‧實際速度
|St|‧‧‧目標速度的絕對值
S11~S14‧‧‧步驟
圖1係為本發明馬達驅動移動平台之控制系統之示意圖。
圖2係為本發明參考速度之示意波形圖。
圖3係為本發明馬達驅動移動平台之速度控制的示意波形圖。
圖4係為本發明馬達驅動移動平台之控制方法的流程圖。
茲有關本發明之技術內容及詳細說明，配合圖式說明如下。
請參見圖1所示，其係為本發明馬達驅動移動平台之控制系統之示意圖。所述速度控制系統(以下簡稱系統)包含控制機制10與移動平台20，即所述控制機制10對移動平台20進行閉迴路(closed-loop)的速度控制，藉此使移動平台20的速度達到預期的目標速度。所述控制機制10包含減法器12、控制器14以及信號轉換器16。以速度控制為例，實際係為對移動平台20的左、右輪進行控制，因此移動平台20係為具有可移動且受控的左、右輪的移動平台20之簡稱。
系統的輸出為移動平台20的實際速度yk，其中實際速度yk可透過速度感測器(圖未示)偵測得到，並且所偵測得到的實際速度yk傳送至減法器12。減法器12另外再接收參考速度rk，其中實際速度yk係追隨參考速度rk進行動態響應。具體地，減法器12接收參考速度rk與實際速度yk，並且將參考速度rk與實際速度yk進行減法運算得到誤差速度ek(即ek=rk-yk)。因此，若誤差速度ek為正值時，表示實際速度yk比參考速度rk慢，反之，若誤差速度ek為負值時，表示實際速度yk比參考速度rk快。故此，控制機制10根據誤差速度ek作為控制器14的輸入，並且配合信號轉換器16的動作(容後說明)，使得實際速度yk加快或減慢，以達到追隨參考速度rk的動態響應。
以速度控制為例，控制器14係為一速度控制器，具體地，控制器14為比例-積分(PI)控制器、比例-積分-微分(PID)控制器、模糊(fuzzy)控制器、模糊比例-積分(fuzzy-PI)控制器、模糊比例-積分-微分(fuzzy-PID)控制器、可程式邏輯控制器(PLC)的其中一者。然不以此為限制，舉凡可提供馬達速度調控設計的控制器，皆可作為速度控制器之用。值得一提，由於比例-積分-微分(PID)控制器中的微分控制項對於輸入信號中的高頻信號特別靈敏，因此，在實際應用上， 通常為求在雜訊較大時仍能達到穩態時更加穩定，而省略微分控制項的使用，即以比例-積分(PI)控制器來實現。其中，比例-積分(PI)控制器的離散表示式為：
Figure 108114465-A0305-02-0007-1
其中，ck為以誤差速度ek作為控制器14(比例-積分(PI)控制器)的輸入所計算得到的速度控制信號、T為取樣時間、KP為比例項參數、TI為積分項時間參數。
因此，若將誤差速度ek、實際速度yk以及目標速度的絕對值|St|作為比例-積分(PI)控制器的輸入，透過比例-積分的運算即可求得速度控制信號ck。其中，當前次目標速度的絕對值與此次目標速度的絕對值不同時，則可根據當下的加、減速關係，調整KP、
Figure 108114465-A0305-02-0007-3
和
Figure 108114465-A0305-02-0007-2
ej等值。
在獲得控制器14輸出的速度控制信號ck後，以速度控制信號ck作為信號轉換器16的輸入，並且配合實際速度yk與目標速度的絕對值|St|的關係，以得到速度驅動信號dk，其中，速度驅動信號dk可以加速驅動信號PWMk與減速驅動信號BKk來實現。在本發明的實施例中，速度驅動信號dk的加速驅動信號PWMk與減速驅動信號BKk可定義為：
一、當移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，即，yk
Figure 108114465-A0305-02-0007-38
|St|，並且假設取樣時間為T、最大責任週期(full duty)為Dfull、參數Cmax=1以及參數Cmin=-1。此外，為了實現當實際速度yk與目標速度的絕對值|St|的差異很小或者很大時，能夠精準地、即時地對速度進行控制，因此，進一步地定義煞車參數(brake standard)為BrakeStd，舉例來說，但不以此為限制：當滿足yk-|St|>
Figure 108114465-A0305-02-0007-39
×最大速度：BrakeStd=64；其中，最大速度為5850rpm； 當不滿足yk-|St|>
Figure 108114465-A0305-02-0008-88
×最大速度：BrakeStd=8；若將上揭速度值以正規化(normalization)表示，即最大速度(5850rpm)=1時，則：當滿足yk-|St|>
Figure 108114465-A0305-02-0008-89
：BrakeStd=64；當不滿足yk-|St|>
Figure 108114465-A0305-02-0008-90
：BrakeStd=8。
因此，速度驅動信號dk的加速驅動信號PWMk與減速驅動信號BKk可根據速度控制信號ck不同的狀況予以定義：1、當Cmax<ck：PWMk=Dfull、BKk=0；2、當Cmax
Figure 108114465-A0305-02-0008-43
ck
Figure 108114465-A0305-02-0008-44
0，可再分為三種狀況：(1)、ck-ck-1<Cmin：PWMk=0、BKk=T；(2)、Cmin
Figure 108114465-A0305-02-0008-45
ck-ck-1<
Figure 108114465-A0305-02-0008-4
：PWMk=0、BKk=T×
Figure 108114465-A0305-02-0008-5
； (3)、ck-ck-1
Figure 108114465-A0305-02-0008-82
：PWMk=Dfull×
Figure 108114465-A0305-02-0008-7
、BKk=0；3、當0>ck
Figure 108114465-A0305-02-0008-46
Cmin：PWMk=0、BKk=T×
Figure 108114465-A0305-02-0008-8
；4、當Cmin>ck：PWMk=0、BKk=T。
舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當Cmax<ck時，表示速度控制信號ck為完全加速的控制，因此，信號轉換器16所輸出速度驅動信號dk的加速驅動信號PWMk=Dfull，而減速驅動信號BKk=0，使得控制移動平台20在完全沒有煞車下，以最大的加速能力進行加速。舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當Cmax
Figure 108114465-A0305-02-0008-47
ck
Figure 108114465-A0305-02-0008-48
0，且為ck-ck-1<Cmin時，表示速度控制信號ck為完全煞車減速的控制，因此，速度驅動信號dk的加速驅動信號PWMk=0，而減速驅動信號BKk=T，使得控制移動平台20在取樣時間T的時間長度(例如 40毫秒)皆為煞車減速的狀態。舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當Cmax
Figure 108114465-A0305-02-0009-49
ck
Figure 108114465-A0305-02-0009-50
0，且為Cmin
Figure 108114465-A0305-02-0009-51
ck-ck-1<
Figure 108114465-A0305-02-0009-83
時，表示欲控制移動平台20為間歇性地煞車減速，且每一次煞車減速的時間長度則為取樣時間T的比例，其中所述比例為
Figure 108114465-A0305-02-0009-85
，亦即煞車減速的時間長度則依前、後兩次速度控制信號(即ck-1與ck)的差異決定。因此當前、後兩次速度控制信號的差異越大，則表示控制移動平台20煞車減速的時間長度越長。舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當Cmax
Figure 108114465-A0305-02-0009-52
ck
Figure 108114465-A0305-02-0009-53
0，且為ck-ck-1
Figure 108114465-A0305-02-0009-86
時，表示欲控制移動平台20以非以完全加速的方式進行加速，且加速的程度則為完全加速(最大責任週期為Dfull)的比例，其中所述比例為
Figure 108114465-A0305-02-0009-12
，亦即加速的程度則依速度控制信號ck決定。因此當速度控制信號ck越大，則表示控制移動平台20加速的程度越大。
舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當0>ck
Figure 108114465-A0305-02-0009-54
Cmin，表示欲控制移動平台20為間歇性地煞車減速，且每一次煞車減速的時間長度則為取樣時間T的比例，其中所述比例為
Figure 108114465-A0305-02-0009-13
，亦即煞車減速的時間長度則依速度控制信號ck決定。舉例來說，在移動方向相同，且實際速度大於或者等於目標速度的絕對值的條件下，當Cmin>ck，表示欲控制移動平台20為完全煞車減速，因此，速度驅動信號dk的加速驅動信號PWMk=0，而減速驅動信號BKk=T，使得控制移動平台20在取樣時間T的時間長度(例如40毫秒)皆為煞車減速的狀態。
二、當移動方向相同，且實際速度小於目標速度的絕對值的條件下，即，yk<|St|，並且假設取樣時間為T、最大責任週期(full duty)為Dfull、參數Cmax=1、參數Cmin=-1以及煞車參數(brake standard)為BrakeStd。因此，速度驅動信 號dk的加速驅動信號PWMk與減速驅動信號BKk可根據速度控制信號ck不同的狀況予以定義：1、當Cmax<ck：PWMk=Dfull、BKk=0；2、當Cmax
Figure 108114465-A0305-02-0010-55
ck
Figure 108114465-A0305-02-0010-56
0，可再分為三種狀況：(1)、ck-ck-1<Cmin：PWMk=0、BKk=0；(2)、Cmin
Figure 108114465-A0305-02-0010-57
ck-ck-1<
Figure 108114465-A0305-02-0010-14
：PWMk=0、BKk=0；(3)、ck-ck-1
Figure 108114465-A0305-02-0010-15
：PWMk=Dfull×
Figure 108114465-A0305-02-0010-16
、BKk=0；3、當0>ck
Figure 108114465-A0305-02-0010-58
Cmin：PWMk=0、BKk=0；4、當Cmin>ck：PWMk=0、BKk=0。
由於第二種控制狀態與第一種控制狀態僅在於實際速度小於目標速度的絕對值的差異，因此詳細的說明不再贅述，可參見第一種控制狀態相應的記載，值得一提的是，在第二種控制狀態中，速度驅動信號dk的減速驅動信號BKk皆為0，而加速驅動信號PWMk則與第一種控制狀態相同。
綜上說明，透過加速驅動信號PWMk與減速驅動信號BKk二者的結合與調整，可達到移動平台20的前進與後退的加速與減速控制。其中，加速驅動信號PWMk的功能相當於油門的概念，而減速驅動信號BKk的功能相當於煞車的概念。若以控制無刷直流馬達(Brushless DC motor,BLDC motor)為應用，則可以加速驅動信號PWMk控制BLDC的馬達驅動板上的腳位(PWM pin)以及以減速驅動信號BKk控制BLDC的馬達驅動板上的腳位(Start/Brake pin)來實現對移動平台20的前進與後退的加速與減速控制，並且對於移動平台20承載不同負載而言，同樣可以自動調整控制的方式，達到平穩地加、減速控制。
再者，可依據不同硬體的運算處理能力，以無條件進位的方式將減速驅動信號BKk設計為可控制煞車時間(例如5毫秒)的倍數，達到可控制的煞車(brake)段數。此外，在前揭的速度控制中，若移動平台20的實際速度yk小於最低可控速度，且目標速度的絕對值|St|為零，則可直接設定加速驅動信號PWMk=0、減速驅動信號BKk=T。然後，將控制器14(例如比例-積分(PI)控制器)的控制機制重置(reset)作為控制方式。直到目標速度的絕對值|St|非為零，再重新啟動比例-積分(PI)控制器的控制機制，並且再透過信號轉換器16對速度控制信號ck加以轉換，而得到速度驅動信號dk的加速驅動信號PWMk與減速驅動信號BKk，進而驅動移動平台20，而得到速度控制系統的下一次實際速度yk+1。換言之，當輸入參考速度rk後，在取樣時間T到達時，直接取樣系統輸出的速度控制結果，即可得到實際速度yk+1。至終，透過閉迴路的速度控制，使移動平台20的速度達到預期的目標速度。
舉例來說，假設取樣時間T=40毫秒(可由選用的微控制器規格所決定)，BLDC馬達的極數=14、BLDC馬達的最小平均速度參數=4，則BLDC馬達的最低可控速度則等於：
Figure 108114465-A0305-02-0011-17
×
Figure 108114465-A0305-02-0011-18
=428.57(rpm)。對應地，根據車輪的尺寸規格，例如車輪的直徑長度可計算出車輪最低可控速度為477.17(0.01cm/s)。
若是其他型態的馬達的驅動方式，具有與BLDC的馬達驅動板上相近或相同的PWM pin與Start/Brake pin，則同樣可透過設定加速驅動信號PWMk與減速驅動信號BKk對該馬達進行速度控制。舉例來說，以一般的有刷直流馬達為例，可在其外部增加電路去控制正負極短路，即可達到煞車的控制，而以PWM的控制，就可以實現加速(油門)的控制。再者，以步進馬達為例，可使用慢慢增加固定位置的時間進行煞車，而可對應為在固定位置的時間的長短實現加速(油門)的控制。
請參見圖2所示，其係為本發明參考速度之示意波形圖。圖2旨在於表示參考速度rk的示意，其中橫座標為時間，縱座標為速度值，以正規化表示，因此最大速度(例如5850rpm)=1。時間t0至時間t1表示移動平台20在空(無)載時的加速，而時間t1至時間t2表示移動平台20在加(有)載時的加速。其中，上揭加速時的加載係指移動平台20於時間t1時加入負載(承載)。換言之，在時間t1時若沒有加載，參考速度rk則仍以時間t0至時間t1的波形進行加速控制。值得一提，空載時參考速度rk每兩階之間速度改變的時間較加載時參考速度rk每兩階之間速度改變的時間來得短。在時間t2至時間t3期間，為控制移動平台20在目標速度下進行移動。時間t3至時間t4表示移動平台20在加載時的減速，而時間t4至時間t5表示移動平台20在無載時減速。其中，上揭減速時的空載係移動平台20於時間t4時卸下負載(承載)。換言之，在時間t4時若沒有卸載，參考速度rk則仍以時間t3至時間t4的波形進行減速控制。值得一提，空載時參考速度rk每兩階之間速度改變的時間較加載時參考速度rk每兩階之間速度改變的時間來得短。
上述時間t0至時間t5所示的參考速度rk的變化，示意為相同方向的加、減速變化。相應地，若移動平台20從目標速度(時間t3)減速到零(時間t5)而停止，再反方向進行加速時，仍可以相近於圖2所示的參考速度之示意波形圖來表現移動平台20加、減速控制，在此不再贅述。
請參見圖3所示，其係為本發明馬達驅動移動平台之速度控制的示意波形圖。圖3所示的三個波形分別為參考速度rk的波形C1、速度控制信號ck的波形C2以及實際速度yk的波形C3。配合圖1如前所述，參考速度rk提供了對移動平台20的速度控制需求，透過控制器14，例如比例-積分(PI)的運算產生速度控制信號ck，再透過信號轉換器16對速度控制信號ck進行轉換，以獲得對應的加速驅動信號PWMk與減速驅動信號BKk，進而對移動平台20進行閉迴路 (closed-loop)的速度控制，使得實際速度yk係追隨參考速度rk進行動態響應，藉此使移動平台20的速度達到預期的目標速度。
請參見圖4所示，其係為本發明馬達驅動移動平台之控制方法的流程圖。所述控制方法的步驟包括：首先，提供參考速度rk、實際速度yk以及目標速度的絕對值|St|(S11)。其中，移動平台20的實際速度yk可透過速度感測器偵測得到，參考速度rk提供了對移動平台20的速度控制需求。
然後，提供控制器14，控制器14根據參考速度rk、實際速度yk以及目標速度的絕對值|St|計算速度控制信號ck(S12)。其中，控制器14可為比例-積分(PI)控制器、比例-積分-微分(PID)控制器、模糊(fuzzy)控制器、模糊比例-積分(fuzzy-PI)控制器、模糊比例-積分-微分(fuzzy-PID)控制器、可程式邏輯控制器(PLC)的其中一者，然不以此為限制。具體地，將參考速度rk與實際速度yk進行減法運算得到誤差速度ek(即ek=rk-yk)，並且配合實際速度yk與目標速度的絕對值|St|作為控制器14的輸入，透過比例-積分的運算(以比例-積分(PI)控制器為例)即可計覦出速度控制信號ck。
然後，提供信號轉換器16，信號轉換器16根據速度控制信號ck、實際速度yk以及目標速度的絕對值|St|計算速度驅動信號dk；其中，速度驅動信號dk包含加速驅動信號PWMk與減速驅動信號BKk(S13)。在獲得控制器14輸出的速度控制信號ck後，以速度控制信號ck作為信號轉換器16的輸入，並且配合實際速度yk與目標速度的絕對值|St|的關係，以得到速度驅動信號dk。最後，根據加速驅動信號PWMk與該減速驅動信號BKk對該移動平台20提供加、減速控制(S14)。所述加速驅動信號PWMk可調整為0、Dfull(最大責任週期)或者與Dfull成 比例的大小；所述減速驅動信號BKk可調整為0、T(取樣時間)或者與T成比例的大小，藉此對移動平台20提供精準的、即時的速度控制。
綜上所述，本發明係具有以下之特徵與優點：
1、無須額外的煞車機構即可實現移動平台的減速，不僅可減少設備成本、維護成本，也降低控制的複雜度。
2、採用對馬達速度的閉迴路控制，可達到自動地、即時地、準確地的速度調整與控制。
以上所述，僅為本發明較佳具體實施例之詳細說明與圖式，惟本發明之特徵並不侷限於此，並非用以限制本發明，本發明之所有範圍應以下述之申請專利範圍為準，凡合於本發明申請專利範圍之精神與其類似變化之實施例，皆應包含於本發明之範疇中，任何熟悉該項技藝者在本發明之領域內，可輕易思及之變化或修飾皆可涵蓋在以下本案之專利範圍。
10‧‧‧控制機制
12‧‧‧減法器
14‧‧‧控制器
16‧‧‧信號轉換器
20‧‧‧移動平台
rk‧‧‧參考速度
ek‧‧‧誤差速度
ck‧‧‧速度控制信號
dk‧‧‧速度驅動信號
yk‧‧‧實際速度
yk+1‧‧‧實際速度

Claims (14)

  1. 一種馬達驅動移動平台之控制系統，用以控制一移動平台之速度，該馬達驅動移動平台之控制系統包含：一減法器，接收一參考速度與一實際速度，且計算該參考速度與該實際速度的差值得到一誤差速度；一控制器，接收該誤差速度、該實際速度以及一目標速度的絕對值，且計算出一速度控制信號；其中，該控制器為比例-積分控制器、比例-積分-微分控制器、模糊控制器、模糊比例-積分控制器、模糊比例-積分-微分控制器、可程式邏輯控制器的其中一者；及一信號轉換器，接收該速度控制信號、該實際速度以及該目標速度的絕對值，且計算出一速度驅動信號；其中，該速度驅動信號包含一加速驅動信號與一減速驅動信號；其中，該加速驅動信號與該減速驅動信號對該移動平台提供加、減速控制。
  2. 如申請專利範圍第1項所述之馬達驅動移動平台之控制系統，其中當該移動平台的移動方向相同，且該實際速度大於或者等於該目標速度的絕對值時，該加速驅動信號與該減速驅動信號為：當Cmax<ck：PWMk=Dfull、BKk=0；當Cmax
    Figure 108114465-A0305-02-0016-59
    ck
    Figure 108114465-A0305-02-0016-60
    0，且ck-ck-1<Cmin：PWMk=0、BKk=T；Cmin
    Figure 108114465-A0305-02-0016-61
    ck-ck-1<
    Figure 108114465-A0305-02-0016-19
    ：PWMk=0、BKk=T×
    Figure 108114465-A0305-02-0016-21
    ； ck-ck-1
    Figure 108114465-A0305-02-0016-87
    ：PWMk=Dfull×
    Figure 108114465-A0305-02-0016-23
    、BKk=0；當0>ck
    Figure 108114465-A0305-02-0016-62
    Cmin：PWMk=0、BKk=T×
    Figure 108114465-A0305-02-0016-24
    ； 當Cmin>ck：PWMk=0、BKk=T；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、Dfull為一最大責任週期、T為一取樣時間、ck、ck-1為該速度控制信號、Cmax為一速度參數最大值(其值為1)、Cmin為一速度參數最小值(其值為-1)、BrakeStd為一煞車參數。
  3. 如申請專利範圍第1項所述之馬達驅動移動平台之控制系統，其中當該移動平台的移動方向相同，且該實際速度小於該目標速度的絕對值時，該加速驅動信號與該減速驅動信號為：當Cmax<ck：PWMk=Dfull、BKk=0；當Cmax
    Figure 108114465-A0305-02-0017-63
    ck
    Figure 108114465-A0305-02-0017-64
    0，且ck-ck-1<Cmin：PWMk=0、BKk=0；Cmin
    Figure 108114465-A0305-02-0017-65
    ck-ck-1<
    Figure 108114465-A0305-02-0017-25
    ：PWMk=0、BKk=0； ck-ck-1
    Figure 108114465-A0305-02-0017-26
    ：PWMk=Dfull×
    Figure 108114465-A0305-02-0017-27
    、BKk=0；當0>ck
    Figure 108114465-A0305-02-0017-66
    Cmin：PWMk=0、BKk=0；當Cmin>ck：PWMk=0、BKk=0；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、Dfull為一最大責任週期、T為一取樣時間、ck、ck-1為該速度控制信號、Cmax為一速度參數最大值(其值為1)、Cmin為一速度參數最小值(其值為-1)、BrakeStd為一煞車參數。
  4. 如申請專利範圍第2或第3項所述之馬達驅動移動平台之控制系統，其中該煞車參數係根據該實際速度、該目標速度的絕對值以及一最大速度所決定。
  5. 如申請專利範圍第4項所述之馬達驅動移動平台之控制系統，其中 當滿足yk-|St|>
    Figure 108114465-A0305-02-0018-91
    ×vmax，該煞車參數為一第一煞車參數值；當不滿足yk-|St|>
    Figure 108114465-A0305-02-0018-92
    ×vmax，該煞車參數為一第二煞車參數值；其中，該第一煞車參數值大於該第二煞車參數值；其中，yk為該實際速度、|St|為該目標速度的絕對值、vmax為該最大速度。
  6. 如申請專利範圍第2或第3項所述之馬達驅動移動平台之控制系統，其中當驅動該移動平台為一無刷直流馬達時，該加速驅動信號係控制一馬達驅動板的PWM pin腳位，該減速驅動信號係控制該馬達驅動板的Start/Brake pin腳位。
  7. 如申請專利範圍第1項所述之馬達驅動移動平台之控制系統，其中當該實際速度小於一最低可控速度，且該目標速度的絕對值為零時，該加速驅動信號與該減速驅動信號為：PWMk=0、BKk=T；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、T為一取樣時間。
  8. 一種馬達驅動移動平台之控制方法，用以控制一移動平台之速度，該控制方法包含：(a)、提供一參考速度、一實際速度以及一目標速度的絕對值；(b)、提供一控制器，該控制器根據該參考速度、該實際速度以及該目標速度的絕對值計算一速度控制信號；(c)、提供一信號轉換器，該信號轉換器根據該速度控制信號、該實際速度以及該目標速度的絕對值計算一速度驅動信號；其中，該速度驅動信號包含一加速驅動信號與一減速驅動信號；及 (d)、根據該加速驅動信號與該減速驅動信號對該移動平台提供加、減速控制。
  9. 如申請專利範圍第8項所述之馬達驅動移動平台之控制方法，其中步驟(b)更包含：計算該參考速度與該實際速度的差值以獲得一誤差速度。
  10. 如申請專利範圍第8項所述之馬達驅動移動平台之控制方法，其中步驟(d)更包含：當該移動平台的移動方向相同，且該實際速度大於或者等於該目標速度的絕對值時，設定該加速驅動信號與該減速驅動信號為：當Cmax<ck：PWMk=Dfull、BKk=0；當Cmax
    Figure 108114465-A0305-02-0019-70
    ck
    Figure 108114465-A0305-02-0019-71
    0，且ck-ck-1<Cmin：PWMk=0、BKk=T；Cmin
    Figure 108114465-A0305-02-0019-72
    ck-ck-1<
    Figure 108114465-A0305-02-0019-28
    ：PWMk=0、BKk=T×
    Figure 108114465-A0305-02-0019-30
    ； ck-ck-1
    Figure 108114465-A0305-02-0019-31
    ：PWMk=Dfull×
    Figure 108114465-A0305-02-0019-32
    、BKk=0； 當0>ck
    Figure 108114465-A0305-02-0019-73
    Cmin：PWMk=0、BKk=T×
    Figure 108114465-A0305-02-0019-33
    ；當Cmin>ck：PWMk=0、BKk=T；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、Dfull為一最大責任週期、T為一取樣時間、ck、ck-1為該速度控制信號、Cmax為一速度參數最大值(其值為1)、Cmin為一速度參數最小值(其值為-1)、BrakeStd為一煞車參數。
  11. 如申請專利範圍第8項所述之馬達驅動移動平台之控制方法，其中步驟(d)更包含： 當該移動平台的移動方向相同，且該實際速度小於該目標速度的絕對值時，設定該加速驅動信號與該減速驅動信號為：當Cmax<ck：PWMk=Dfull、BKk=0；當Cmax
    Figure 108114465-A0305-02-0020-75
    ck
    Figure 108114465-A0305-02-0020-76
    0，且ck-ck-1<Cmin：PWMk=0、BKk=0；Cmin
    Figure 108114465-A0305-02-0020-77
    ck-ck-1<
    Figure 108114465-A0305-02-0020-34
    ：PWMk=0、BKk=0； ck-ck-1
    Figure 108114465-A0305-02-0020-36
    ：PWMk=Dfull×
    Figure 108114465-A0305-02-0020-37
    、BKk=0；當0>ck
    Figure 108114465-A0305-02-0020-78
    Cmin：PWMk=0、BKk=0；當Cmin>ck：PWMk=0、BKk=0；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、Dfull為一最大責任週期、T為一取樣時間、ck、ck-1為該速度控制信號、Cmax為一速度參數最大值(其值為1)、Cmin為一速度參數最小值(其值為-1)、BrakeStd為一煞車參數。
  12. 如申請專利範圍第10或第11項所述之馬達驅動移動平台之控制方法，其中步驟(d)更包含：根據該實際速度、該目標速度的絕對值以及一最大速度設定該煞車參數。
  13. 如申請專利範圍第12項所述之馬達驅動移動平台之控制方法，其中步驟(d)更包含：設定該煞車參數為一第一煞車參數值，當滿足yk-|St|>
    Figure 108114465-A0305-02-0020-94
    ×vmax；設定該煞車參數為一第二煞車參數值，當不滿足yk-|St|>
    Figure 108114465-A0305-02-0020-95
    ×vmax；其中，該第一煞車參數值大於該第二煞車參數值；其中，yk為該實際速度、|St|為該目標速度的絕對值、vmax為該最大速度。
  14. 如申請專利範圍第8項所述之馬達驅動移動平台之控制方法，其中步驟(d)更包含：當該實際速度小於一最低可控速度，且該目標速度的絕對值為零時，設定該加速驅動信號與該減速驅動信號為：PWMk=0、BKk=T；其中，PWMk為該加速驅動信號、BKk為該減速驅動信號、T為一取樣時間。
TW108114465A 2019-04-25 2019-04-25 馬達驅動移動平台之控制系統及其控制方法 TWI684319B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW108114465A TWI684319B (zh) 2019-04-25 2019-04-25 馬達驅動移動平台之控制系統及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108114465A TWI684319B (zh) 2019-04-25 2019-04-25 馬達驅動移動平台之控制系統及其控制方法

Publications (2)

Publication Number Publication Date
TWI684319B true TWI684319B (zh) 2020-02-01
TW202040928A TW202040928A (zh) 2020-11-01

Family

ID=70413245

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108114465A TWI684319B (zh) 2019-04-25 2019-04-25 馬達驅動移動平台之控制系統及其控制方法

Country Status (1)

Country Link
TW (1) TWI684319B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114442617A (zh) * 2022-01-06 2022-05-06 东风柳州汽车有限公司 一种agv小车的控制方法及装置

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW435040B (en) * 1997-02-27 2001-05-16 Canon Kk Image reading apparatus
US20060125863A1 (en) * 2004-05-27 2006-06-15 Silverbrook Research Pty Ltd Printer controller for controlling a printhead module based on thermal sensing
US20060125858A1 (en) * 2004-05-27 2006-06-15 Silverbrook Research Pty Ltd Printer controller for supplying data to a printhead module having one or more redundant nozzle rows
US20070070834A1 (en) * 2001-04-02 2007-03-29 Naruhiro Masui Signal processing method and signal processing apparatus
CN103280209A (zh) * 2012-01-18 2013-09-04 雅马哈株式会社 装配踏板的乐器及其方法
CN107148741A (zh) * 2014-12-22 2017-09-08 日本电产株式会社 位置估计方法和位置控制装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW435040B (en) * 1997-02-27 2001-05-16 Canon Kk Image reading apparatus
US20070070834A1 (en) * 2001-04-02 2007-03-29 Naruhiro Masui Signal processing method and signal processing apparatus
US20060125863A1 (en) * 2004-05-27 2006-06-15 Silverbrook Research Pty Ltd Printer controller for controlling a printhead module based on thermal sensing
US20060125858A1 (en) * 2004-05-27 2006-06-15 Silverbrook Research Pty Ltd Printer controller for supplying data to a printhead module having one or more redundant nozzle rows
CN103280209A (zh) * 2012-01-18 2013-09-04 雅马哈株式会社 装配踏板的乐器及其方法
CN107148741A (zh) * 2014-12-22 2017-09-08 日本电产株式会社 位置估计方法和位置控制装置

Also Published As

Publication number Publication date
TW202040928A (zh) 2020-11-01

Similar Documents

Publication Publication Date Title
TW201633669A (zh) 伺服馬達系統及其控制方法
KR20030070772A (ko) 인버터의 토오크 제어장치 및 방법
WO2003031309A1 (fr) Unite de commande de frein d&#39;ascenseur
TWI684319B (zh) 馬達驅動移動平台之控制系統及其控制方法
KR101657020B1 (ko) 엘리베이터의 제어 장치 및 엘리베이터의 제어 방법
US9975531B2 (en) Braking control device for vehicle
JP5219103B2 (ja) 走行制御装置
JP2007336687A (ja) モータ制御装置
CN111865173A (zh) 马达驱动移动平台的控制***及其控制方法
CN113119751B (zh) 车辆斜坡启动方法、装置、车辆、电子设备和存储介质
JP2000341991A (ja) 永久磁石型同期電動機の制御装置
CN109305612B (zh) 电梯启动控制装置
CN111416561B (zh) 一种改进的电机三环控制方法
JPH11252994A (ja) ステッピングモータの制御装置および制御方法
JP5796473B2 (ja) 車両の制動制御装置
JP2013115988A (ja) 車両の制動制御装置
JP7184129B1 (ja) エレベーターの制御装置及びエレベーターの制御方法
JP2000261903A (ja) 電気車制御装置
CN114929607A (zh) 驱动***和用于控制驱动***的方法
JPH0569041U (ja) モータのブレーキ制御装置
JP5895481B2 (ja) 車両の制動制御装置
JP6950786B1 (ja) エレベーターの制御装置及び制御方法
CN114906765B (zh) 电梯抱闸控制方法、装置、设备及存储介质
TW202248776A (zh) 基於負載轉矩－轉動慣量自學習模型之速度控制方法與電機驅動系統
CN115987175A (zh) 用于运行电机的方法