TW202119148A - 機器人及校正其馬達的角速度的微控制單元及方法 - Google Patents

Abstract

一種機器人及校正其馬達的角速度的微控制單元及方法被揭露。該機器人的本體包含馬達及驅動器。該微控制單元設置在該馬達內，感測該馬達的轉子的磁場並產生二個電壓訊號。接著，該微控制單元自該驅動器接收脈衝訊號，並依據該脈衝訊號計算該轉子的理想角速度。隨後，該微控制單元基於該二個電壓訊號計算該轉子的當前角速度，並依據該當前角速度與該理想角速度之間的差異，傳送校正訊號至該馬達的脈寬調變電壓放大器，以便該脈寬調變電壓放大器依據該校正訊號校正該轉子之該當前角速度，進而調整該機器人的動作。

Description

機器人及校正其馬達的角速度的微控制單元及方法

本揭露是關於一種機器人的控制。更具體而言，本揭露是關於一種機器人與校正其馬達的角速度的微控制單元及方法。

現今社會眾多服務型機器人可於餐廳、旅館大廳、機場等場域中為眾人提供服務。服務型機器人可自主控制，亦可經由一雲端整合平台提供一雲端編輯器來控制機器人控制及發送指令，以使機器人執行相應的各種服務動作。由於服務型機器人需要和人員近距離接觸和互動，若其馬達的轉動控制不夠精確，將導致移動速度過慢或是定位不準，對於所提供的服務就會不夠精準，讓使用者的服務體驗不佳。

傳統的機器人及其馬達多為透過一驅動器以及一脈寬調變電壓放大器(Pulse Width Modulation Amplifier)來進行一轉子的轉動控制以及轉動補償。具體而言，該驅動器可依需求決定該轉子轉動的角速度，並且透過該脈寬調變電壓放大器而控制該轉子的轉動(亦即，轉動控制)。當該驅動器感測出該轉子於實際轉動時的一當前角速度與該驅動器所決定的角速度存在差異時，該驅動器可依據該差異傳送一校正訊號至該脈寬調變電壓放大器，以讓該脈寬調變電壓放大器依據該校正訊號調整該轉子的該當 前角速度(亦即，轉動補償)。

馬達的驅動器通常被設置於馬達的外部，這使得二者之間的訊號傳輸費時，且每當該訊號傳輸發生延遲或中斷時，都將造成驅動器無法即時針對馬達進行轉動補償。除了馬達及其與驅動器之間的傳輸延遲之外，為了實現智能操作，驅動器通常需要由一中控電腦來控制，而驅動器和中控電腦之間的訊號傳輸時間，也會降低驅動器針對馬達進行轉動補償的效率。針對馬達進行轉動補償的效率越低，則馬達出現異常的機率就越高。舉例而言，在馬達被用來控制機器人動作的情況下，若驅動器無法即時針對馬達進行轉動補償，則該機器人就可能因為當下錯誤的轉子角速度而作出危險或無意義的動作。有鑑於此，如何提升針對馬達進行轉動補償的效率，在所屬技術領域中將是非常重要的。

為了至少解決上述問題，本揭露提供一種校正一馬達的角速度的微控制單元(Micro Control Unit，MCU)。該微控制單元可設置於該馬達內。該馬達可包含一脈寬調變電壓放大器和一轉子，且該脈寬調變電壓放大器可與一驅動器電性連接。該微控制單元可分別與該脈寬調變電壓放大器以及該驅動器電性連接。該微控制單元可包含二個霍爾感測器以及與該二個霍爾感測器電性連接的一校正模組。該二個霍爾感測器可用以感測該轉子的磁場並且產生二個電壓訊號。該校正模組可用以自該驅動器接收一脈衝訊號，並且依據該脈衝訊號計算該轉子的一理想角速度。除此之外，該校正模組還可用以基於該二個電壓訊號，計算該轉子的一當前角速度，並且依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該脈寬 調變電壓放大器，使該脈寬調變電壓放大器依據該校正訊號調整該轉子之該當前角速度。

為了至少解決上述問題，本揭露還提供一種校正一馬達的角速度的方法。該方法可包含：

一微控制單元感測該馬達的一轉子的磁場並且產生二個電壓訊號，其中該微控制單元設置於該馬達內；

該微控制單元自該馬達的一驅動器接收一脈衝訊號；

該微控制單元依據該脈衝訊號計算該轉子的一理想角速度；

該微控制單元基於該二個電壓訊號計算該轉子的一當前角速度；以及

該微控制單元依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該馬達的一脈寬調變電壓放大器，使該脈寬調變電壓放大器依據該校正訊號校正該轉子之該當前角速度。

為了至少解決上述問題，本揭露還提供一種機器人。該機器人可包含一機器人本體以及一微控制單元。該機器人本體可包含一馬達及一驅動器。該馬達可與該驅動器電性連接，且該馬達可包含一脈寬調變電壓放大器以及一轉子。該微控制單元可設置於該馬達內，且可與該脈寬調變電壓放大器以及該驅動器電性連接。該微控制單元可包含二個霍爾感測器以及與該二個霍爾感測器電性連接的一校正模組。該二個霍爾感測器可用以感測該轉子的磁場並且產生二個電壓訊號。該校正模組可用以自該驅動器接收一脈衝訊號，並且依據該脈衝訊號計算該轉子的一理想角速度。除此之外，該校正模組還可用以基於該二個電壓訊號計算該轉子的一當前角速度，並且依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該 脈寬調變電壓放大器，以便該脈寬調變電壓放大器依據該校正訊號調整該轉子之該當前角速度，進而調整該機器人的動作。

如上所述，在本發明的實施例中，微控制單元能夠自行地感測馬達的轉子的磁場，並直接傳送校正訊號至馬達的脈寬調變電壓放大器。因此，在本發明的實施例中，針對馬達進行轉動補償的角色是微控制單元，而不再是驅動器，且在微控制單元針對馬達進行轉動補償的過程中並不需要中控電腦的介入，故能避免傳統驅動器和中控電腦之間的傳輸延遲。另一方面，在本發明的實施例中，微控制單元是被設置馬達內，故其與馬達之間的傳輸路徑小於驅動器與馬達之間的傳輸路徑，也因此，微控制單元與馬達之間的傳輸延遲小於傳統驅動器和馬達之間的傳輸延遲。很明顯地，在本發明的實施例中，能更即時針對馬達進行轉動補償，且能有效地提升針對馬達進行轉動補償的效率。

1‧‧‧馬達

11‧‧‧微控制單元

111a、111b‧‧‧霍爾感測器

112‧‧‧雙頻機磁模組

113‧‧‧雙極磁性模組

12‧‧‧脈寬調變電壓放大器

13‧‧‧轉子

14‧‧‧軸承

141‧‧‧軸心

15‧‧‧轉動平面

2‧‧‧驅動器

3‧‧‧中控計算機

4‧‧‧雲端整合平台

5‧‧‧校正馬達的角速度的方法

501、502、503、504、505‧‧‧步驟

BD‧‧‧機器人本體

CM‧‧‧校正模組

RB‧‧‧機器人

S1‧‧‧脈衝訊號

S2‧‧‧校正訊號

S3‧‧‧理想角速度指令

第1A圖例示了依據本發明的一或多個實施例的馬達。

第1B圖例示了依據本發明的一或多個實施例的機器人。

第2A圖例示了依據本發明的一或多個實施例的馬達轉子與霍爾感測器的俯視圖。

第2B圖例示了第2A圖所示的馬達轉子與霍爾感測器的側視圖。

第3圖例示了依據本發明的一或多個實施例的校正馬達的角速度的方法。

以下所述各種實施例並非用以限制本發明只能在所述的環境、應用、結構、流程或步驟方能實施。於圖式中，與本發明的實施例非直接相關的元件皆已省略。於圖式中，各元件的尺寸以及各元件之間的比例僅是範例，而非用以限制本發明。除了特別說明之外，在以下內容中，相同(或相近)的元件符號可對應至相同(或相近)的元件。在可被實現的情況下，如未特別說明，以下所述的每一個元件的數量是指一個或多個。

第1A圖例示了依據本發明的一或多個實施例的馬達。第1A圖所示內容僅是為了說明本發明的實施例，而非為了限制本發明。

參照第1A圖，馬達1可以是各種已知類型的馬達，例如無刷直流電(Brushless Direct Current，BLDC)馬達、伺服馬達(Servo Motor)或步進馬達(Step Motor)等。因本發明所屬技術領域中具有通常知識者已知各種類型的馬達1的基本結構，故馬達1中與本發明的實施例無直接關係的元件，將於本文與圖式中省略。馬達1基本上可包含脈寬調變電壓放大器12以及與脈寬調變電壓放大器12電性連接的轉子(Rotor)13。轉子13可相對於一定子(Stator)進行轉動，而脈寬調變電壓放大器12則可用以產生不同脈寬的電壓訊號，以控制轉子13的轉動。

驅動器2的作用是控制馬達1的轉動(即，轉動控制)。詳言之，驅動器2與脈寬調變電壓放大器12電性連接，且可傳送控制訊號至脈寬調變電壓放大器12，以命其控制轉子13的轉動，藉以驅動馬達1。在某些實施例中，為了實現智能控制，驅動器2針對馬達1的轉動控制可以依據中控計算機3的指令來進行。中控計算機3可以至少包含一處理器及一記憶體，具有儲存及運算之能力，且可自行產生指令及/或處理來自外部的指令。

第1B圖例示了依據本發明的一或多個實施例的機器人。第1B圖所示內容僅是為了說明本發明的實施例，而非為了限制本發明。

同時參照第1A圖以及第1B圖，在某些實施例中，馬達1、驅動器2以及中控計算機3可被設置於一個機器人RB的機器人本體BD中，且馬達1、驅動器2以及中控計算機3可共同運行以使機器人本體BD執行各種動作。在某些實施例中，機器人RB的中控計算機3還可透過一有線網路或一無線網路與雲端整合平台4連接，以與雲端整合平台4進行各種互動。舉例而言，假設機器人RB是在餐廳、旅館大廳、機場等場域中的一服務型機器人，則雲端整合平台4可向機器人RB的中控計算機3發送指令，以使機器人RB執行相應的各種服務動作，並接收來自於機器人RB的中控計算機3的反饋資料。在某些實施例中，馬達1、驅動器2以及中控計算機3也可被設置於一路上交通工具、一海上交通工具、一飛行器或是任何其他具有馬達的裝置等，而不限於機器人。

馬達1的轉動控制是否精確會直接影響到馬達1的品質，進而限制其應用層面。舉例而言，若馬達1的轉動控制不夠精確，則可能無法應用到服務型機器人或精密型機器人。馬達1的轉動控制包含轉子13的角速度控制，而每當轉子13的角速度不符合預期時，微控制單元11將立即地針對馬達1的轉子13進行轉動補償。

第2A圖例示了依據本發明的一或多個實施例的馬達轉子與霍爾感測器的俯視圖。第2B圖例示了第2A圖所示的馬達轉子與霍爾感測器的側視圖。第2A圖以及第2B圖所示內容僅是為了說明本發明的實施例，而非為了限制本發明。

同時參照第1A圖、第2A圖以及第2B圖，微控制單元11設置於馬達1內(例如物理連接至於馬達1的外殼內部或其內部元件)，且分別與驅動器2以及脈寬調變電壓放大器12電性連接。微控制單元11可直接控制脈寬調變電壓放大器12，以對轉子13進行更即時的轉動補償，故可取代傳統透過驅動器2對馬達1進行轉動補償，其效率更快且準確度將更高。

具體而言，在某些實施例中，微控制單元11可包含二個霍爾感測器111a及111b以及與霍爾感測器111a及111b電性連接的校正模組CM。霍爾感測器111a及111b各自可用以感測轉子13的磁場，並且透過磁電訊號轉換產生二個電壓訊號。在某些實施例中，在該磁電訊號轉換的過程中，還可包含透過一濾波器濾除該二個電壓訊號中的雜訊。

以第2A圖以及第2B圖為例，霍爾感測器111a及111b在微控制單元11中的位置可分別對應至馬達1的轉動平面15上的一零度位置以及一九十度位置，而轉動平面15可以是馬達1的軸承14於轉動時，從軸承14的軸心141的一延伸線所構成的平面。該零度位置以及該九十度位置是以轉動平面15與該延伸線的一交會點為圓心，且在同一半徑上。此外，軸承14的轉動方向與角速度均與轉子13的轉動方向與角速度一致。在某些實施例中，霍爾感測器111a在微控制單元11中的位置可對應至馬達1的轉動平面15上任一角度的位置，且與霍爾感測器111b在微控制單元11中的位置相差90度。

在某些實施例中，校正模組CM可包含一雙頻機磁模組(Bifrequency Magnetic Module)112以及一雙極磁性模組(Bipolar Magnetic Module)113。雙極磁性模組113分別與雙頻機磁模組112、霍爾感測器111a及111b電性連接。由於霍爾感測器111a及111b分別位於該零度位置與該九十度位置， 故雙極磁性模組113可利用霍爾感測器111a及111b於位置上的正交關係來計算其所產生的二個電壓訊號之間的相位差，並根據該相位差產生一相位差訊號。

在某些實施例中，雙極磁性模組113還可選擇性執行一高頻調解分析法來分析該相位差訊號是否異常。在某些實施例中，雙極磁性模組113還可選擇性地針對該相位差訊號進行正規化，以確保該相位差訊號的數值是介於0伏特至5伏特之間。

在雙極磁性模組113產生該電壓訊號的相位差訊號之後，雙頻機磁模組112可將該相位差訊號差進行一座標轉換，以計算出一當前角速度。舉例而言，假設轉子13的一「N極」轉至該零度位置，則位於該零度位置的霍爾感測器111a的感測電壓可以達到一上限感測電壓(例如：5伏特)，而位於該九十度位置的霍爾感測器111b感測到的磁場將較弱(例如：2.5伏特)，此時雙頻機磁模組112可根據該二個霍爾感測器的電壓訊號之間的相位差得知轉子13的「N極」目前位於該零度位置。接著，經過座標轉換後，雙頻機磁模組112便可算出轉子13的當前角度。然後，依據於不同時間點所計算的當前角度，雙頻機磁模組112便可計算出轉子13的當前角速度。

在某些實施例中，雙頻機磁模組112還可透過中控計算機3將該當前角速度傳送至雲端整合平台4。

除了計算轉子13的該當前角速度之外，雙頻機磁模組112還可自驅動器2接收脈衝訊號S1，並且依據脈衝訊號S1來計算轉子13的一理想角速度。在某些實施例中，中控計算機3可提供理想角速度指令S3至驅動器2，以把轉子13的角速度的一理想值通知驅動器2，驅動器2則可透過一脈衝 轉換器來依據該理想值而產生脈衝訊號S1，並且將脈衝訊號S1傳送至雙頻機磁模組112。在某些實施例中，理想角速度指令S3可以是基於來自雲端整合平台4的一動作指令所產生，換言之，使用者或管理者可透過雲端整合平台4來指定一特定動作或指定一服務(包含至少一動作)，而中控計算機3可據以產生相應的理想角速度指令S3。

於獲得轉子13的當前角速度以及理想角速度之後，雙頻機磁模組112便可依據該當前角速度與該理想角速度之間的差異，傳送校正訊號S2至脈寬調變電壓放大器12。舉例而言，雙頻機磁模組112可依據該當前角速度與該理想角速度之間的該差異，利用已知的超前-滯後補償器(lead-lag compensator)產生校正訊號S2。然後，脈寬調變電壓放大器12便可依據校正訊號S2改變馬達1的電壓，進而調整轉子13的當前角速度(即，轉動補償)。

透過上述針對馬達1的即時轉動補償，第1B圖所示的機器人本體BD的動作可立即地被調整或補償，故能確保其所有動作都是符合預期且精確的。

在某些實施例中，雙頻機磁模組112還可透過中控計算機3將調整後的該當前角速度而傳送至雲端整合平台4。

在某些實施例中，雲端整合平台4可提供一圖形使用者介面(GUI)，以讓使用者或管理者透過雲端整合平台4來控制機器人RB中的中控計算機3，以與機器人RB進行各種互動。

第3圖例示了依據本發明的一或多個實施例的校正馬達的角速度的方法。第3圖所示內容僅是為了說明本發明的實施例，而非為了限制本發明。

參照第3圖，一種校正馬達的角速度的方法5可包含以下步驟：

一微控制單元感測一馬達的一轉子的磁場並且產生二個電壓訊號(標示為501)，其中該微控制單元設置於該馬達內；

該微控制單元自該馬達的一驅動器接收一脈衝訊號(標示為502)；

該微控制單元依據該脈衝訊號計算該轉子的一理想角速度(標示為503)；

該微控制單元基於該二個電壓訊號計算該轉子的一當前角速度(標示為504)；以及

該微控制單元依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該馬達的一脈寬調變電壓放大器，使該脈寬調變電壓放大器依據該校正訊號校正該轉子之該當前角速度(標示為505)。

第3圖所示的步驟順序並非限制，在可以實現的情況下，第3圖所示的步驟順序可以被任意調整。

在某些實施例中，關於校正馬達的角速度的方法5，該微控制單元可透過二個霍爾感測器來感測該轉子的磁場，且該二個霍爾感測器於該微控制單元中的位置可分別對應至該馬達的一轉動平面上的一零度位置以及一九十度位置。該轉動平面可為該馬達之一軸承於轉動時，從該軸承之一軸心的一延伸線所構成的平面。

在某些實施例中，校正馬達的角速度的方法5還可包含以下步驟：

該微控制單元根據該二個電壓訊號的相位差產生一相位差訊號；以及

該微控制單元將該相位差訊號進行一座標轉換，以計算出該當前角速度。

在某些實施例中，關於校正馬達的角速度的方法5，該微控制單元可透過一超前-滯後補償器來產生該校正訊號。

在某些實施例中，關於校正馬達的角速度的方法5，該脈寬調變電壓放大器可依據該校正訊號改變該馬達的一電壓來調整該當前角速度。

除了上述實施例之外，校正馬達的角速度的方法5還包含與馬達1的上述所有實施例相對應的其他實施例。因本發明所屬技術領域中具有通常知識者可根據上文針對馬達1的說明而瞭解校正馬達的角速度的方法5的這些其他實施例，於此不再贅述。

雖然本文揭露了多個實施例，但該等實施例並非用以限制本發明，且在不脫離本發明的精神和範圍的情況下，該等實施例的等效物或方法(例如，對上述實施例進行修改及/或合併)亦是本發明的一部分。本發明的範圍以申請專利範圍所界定的內容為準。

5‧‧‧校正馬達的角速度的方法

501、502、503、504、505‧‧‧步驟

Claims (13)

1. 一種校正一馬達的角速度的微控制單元，設置於該馬達內，該馬達包含一脈寬調變電壓放大器(Pulse Width Modulation Amplifier)和一轉子，該脈寬調變電壓放大器與一驅動器電性連接，該微控制單元分別與該脈寬調變電壓放大器以及該驅動器電性連接，且該微控制單元包含：

   二個霍爾感測器，用以感測該轉子的磁場並且產生二個電壓訊號；以及

   一校正模組，與該二個霍爾感測器電性連接，用以：

   自該驅動器接收一脈衝訊號；

   依據該脈衝訊號計算該轉子的一理想角速度；

   基於該二個電壓訊號，計算該轉子的一當前角速度；以及

   依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該脈寬調變電壓放大器，使該脈寬調變電壓放大器依據該校正訊號調整該轉子之該當前角速度。
2. 如請求項1所述的微控制單元，其中該二個霍爾感測器於該微控制單元中的位置分別對應至該馬達的一轉動平面上的一零度位置以及一九十度位置，其中該轉動平面係為該馬達之一軸承於轉動時，從該軸承之一軸心的一延伸線所構成的平面。
3. 如請求項1所述的微控制單元，其中該校正模組還用以：

   根據該二個電壓訊號的相位差產生一相位差訊號；且

   將該相位差訊號進行一座標轉換，以計算出該當前角速度。
4. 如請求項1所述的微控制單元，其中該校正模組透過一超前-滯後補償器 產生該校正訊號。
5. 如請求項1所述的微控制單元，其中該脈寬調變電壓放大器依據該校正訊號改變該馬達的一電壓來調整該當前角速度。
6. 一種校正一馬達的角速度的方法，包含：

   一微控制單元感測該馬達的一轉子的磁場並且產生二個電壓訊號，其中該微控制單元設置於該馬達內；

   該微控制單元自該馬達的一驅動器接收一脈衝訊號；

   該微控制單元依據該脈衝訊號計算該轉子的一理想角速度；

   該微控制單元基於該二個電壓訊號計算該轉子的一當前角速度；以及

   該微控制單元依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該馬達的一脈寬調變電壓放大器，使該脈寬調變電壓放大器依據該校正訊號校正該轉子之該當前角速度。
7. 如請求項6所述的方法，其中：

   該微控制單元透過二個霍爾感測器來感測該轉子的磁場；且

   該二個霍爾感測器於該微控制單元中的位置分別對應至該馬達的一轉動平面上的一零度位置以及一九十度位置，其中該轉動平面係為該馬達之一軸承於轉動時，從該軸承之一軸心的一延伸線所構成的平面。
8. 如請求項6所述的方法，還包含：

   該微控制單元根據該二個電壓訊號的相位差產生一相位差訊號；以及

   該微控制單元將該相位差訊號進行一座標轉換，以計算出該當前角 速度。
9. 如請求項6所述的方法，其中該微控制單元透過一超前-滯後補償器來產生該校正訊號。
10. 如請求項6所述的方法，其中該脈寬調變電壓放大器依據該校正訊號改變該馬達的一電壓來調整該當前角速度。
11. 一種機器人，包含：

    一機器人本體，包含一馬達及一驅動器，該馬達包含一脈寬調變電壓放大器以及一轉子，該脈寬調變電壓放大器與該驅動器電性連接；

    一微控制單元，設置於該馬達內，其分別與該脈寬調變電壓放大器以及該驅動器電性連接，且包含：

    二個霍爾感測器，用以感測該轉子的磁場並且產生二個電壓訊號；以及

    一校正模組，與該二個霍爾感測器電性連接，用以：

    自該驅動器接收一脈衝訊號；

    依據該脈衝訊號計算該轉子的一理想角速度；

    基於該二個電壓訊號計算該轉子的一當前角速度；以及

    依據該當前角速度與該理想角速度之間的差異，傳送一校正訊號至該脈寬調變電壓放大器，以便該脈寬調變電壓放大器依據該校正訊號調整該轉子之該當前角速度，進而調整該機器人的動作。
12. 如請求項11所述的機器人，其中該機器人本體還包含一中控計算機；其中：

    該中控計算機與該驅動器電性連接，用以提供該驅動器一理想角速 度指令；且

    該驅動器還用以依據該理想角速度指令，傳送該脈衝訊號至該校正模組。
13. 如請求項12所述的機器人，其中該中控計算機還透過一網路與一雲端整合平台連接，以與該雲端整合平台互動。

Images