驅動控制系統及具有該控制系統的穩定雲臺的製作方法

2023-04-24 03:04:11

本發明涉及穩定雲臺技術領域，尤其涉及一種驅動控制系統及具有該控制系統的穩定雲臺。

背景技術：

近年來，各類動基座成像雲臺廣泛用於航拍、無人車、機器人等領域，越來越受到人們的關注。特別是利用無人機進行航拍，具有快速、靈活、清晰、準確地獲取人們感興趣區域的照片、視頻信息的重要手段。但是對於以無人機為代表的動基座載體，在移動過程中不可避免地存在載體姿態的變化、振動等影響，導致視頻嚴重晃動、照片模糊不清。穩定雲臺的誕生解決了這一問題。穩定雲臺由多自由度的機械機構、各軸上的驅動電機以及控制電路所組成。常見的雲臺電機包括航模用的舵機、帶有減速機構的直流伺服電機、步進電機以及無刷電機等。但是，現有的無刷雲臺驅動控制系統中，有一部分流過電機的電流並沒有有效地參與做功，導致能耗高，並且難以進一步提升穩定精度。

技術實現要素：

本發明旨在解決現有技術中有一部分流過電機的電流並沒有有效地參與做功的技術問題，提供一種能使流過電機的電流有效地參與做功的驅動控制系統及具有該控制系統的穩定雲臺。

本發明提供一種驅動控制系統，所述驅動控制系統包括：

穩定級數字控制系統和至少一個功率級數字控制系統連接且按照所述功率級數字控制系統的順序與所述功率級數字控制系統進行通信，用於根據獲取穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的慣性姿態信息；獲取穩定雲臺的穩定框架繞三軸的相對轉動角度；根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度；根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量並輸出至所述功率級數字控制系統；

所述功率級數字控制系統與至少一個無刷電機連接，用於判斷當前是否存在電角度絕對初始值；如果不存在電角度絕對初始值時，在初始化模式下得到當前的電角度值、交軸電壓控制量、直軸電壓控制量和電角度絕對初始值；如果存在電角度絕對初始值時，獲取絕對角位置傳感器的角度值，根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值，以及得到所述交軸電壓控制量和直軸電壓控制量；根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動。

本發明還提供一種穩定雲臺，包括上述的驅動控制系統和與所述驅動系統對應連接的無刷電機。

本發明的技術方案與現有技術相比，有益效果在於：在電流開環模式下進行計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下進行計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功。

附圖說明

圖1為本發明無刷電機的驅動控制系統一種實施例的結構示意圖。

圖2為本發明多路信息交互接口一種實施例的電路圖。

圖3為本發明多路信息交互接口另一種實施例的電路圖。

圖4為本發明三相橋驅動組件一種實施例的電路圖。

圖5為本發明三相橋驅動組件另一種實施例的電路圖。

圖6(a)是本發明的無刷電機與功率級控制器的第一種實施例接線圖。

圖6(b)是本發明的無刷電機與功率級控制器的第二種實施例接線圖。

圖6(c)是本發明的無刷電機與功率級控制器的第三種實施例接線圖。

圖7為本發明功率級數字控制系統一種實施例的結構示意圖。

圖8為本發明穩定級數字控制系統一種實施例的結構示意圖。

圖9為本發明用於控制電機轉動的矢量控制方法第一種實施例的流程圖。

圖10為本發明用於控制電機轉動的矢量控制方法第二種實施例的流程圖。

圖11為本發明用於控制電機轉動的矢量控制方法第三種實施例的流程圖。

圖12為本發明用於控制電機轉動的矢量控制方法第四種實施例的流程圖。

圖13為本發明穩定雲臺轉動的控制方法第一種實施例的流程圖。

圖14為本發明穩定雲臺轉動的控制方法第二種實施例的流程圖。

圖15為本發明穩定雲臺轉動的控制方法第三種實施例的流程圖。

圖中，1、穩定級數字控制系統，2、功率級數字控制系統，3、穩定雲臺轉動的控制晶片。4、慣性測量器，5、多路信息交互接口，6、圖像追蹤器，7、通信接口，8、功率級控制器，9、三相橋驅動組件，10、電流傳感器，11、無刷電機，12、絕對角位置傳感器。

具體實施方式

下面結合附圖對本發明的具體實施方式作進一步說明。

穩定雲臺轉動的驅動控制系統作為航拍攝影、監測、遙感、採樣雲臺的核心控制裝置，能夠在穩定雲臺的穩定框架產生角運動的工作條件下，例如掛在在無人機上的雲臺，無人機發生飛行姿態變化，通過控制穩定雲臺各軸的無刷電機轉動，保證穩定雲臺上承載的成像裝置指向角度始終保持慣性穩定或始終指向感興趣的目標。

本發明提供一種實施例的無刷電機的驅動控制系統，如圖1所示，所述驅動控制系統包括穩定級數字控制系統1和至少一個功率級數字控制系統2連接且按照所述功率級數字控制系統2的順序與所述功率級數字控制系統2進行通信，用於根據獲取穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的慣性姿態信息；獲取穩定雲臺的穩定框架繞三軸的相對轉動角度；根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度；根據所述穩定雲臺的穩定框架的慣性角速度和穩定雲臺的穩定框架的慣性姿態信息進行閉環穩定控制，並輸出穩定環閉環控制指令；根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量並輸出至所述功率級數字控制系統2；

所述功率級數字控制系統2與至少一個無刷電機11連接，用於判斷當前是否存在電角度絕對初始值；如果不存在電角度絕對初始值時，在初始化模式下得到當前的電角度值、交軸電壓控制量、直軸電壓控制量和電角度絕對初始值；如果存在電角度絕對初始值時，獲取絕對角位置傳感器的角度值，根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值，以及得到所述交軸電壓控制量和直軸電壓控制量；根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動。

具體的，如圖1所示，所述驅動控制系統包括n個功率級數字控制系統2，第一個功率級數字控制系統的序號為2-1，第二個功率級數字控制系統的序號2-2，第n個功率級數字控制系統的序號2-n,穩定級數字控制系統1可以按照所述功率級數字控制系統2的序號從小到大或從大到小的順序與所述功率級數字控制系統2進行通信,其中，n為大於等於1的正整數。

在具體實施中，所述功率級控制器8，還用於獲取當前的工作模式，並判斷當前的工作模式為電流開環模式或者電流閉環模式；

當前的工作模式為電流閉環模式，根據獲取到兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量；

當前的工作模式為電流開環模式，獲取交軸電壓控制量和直軸電壓控制量。

在具體實施中，所述功率級控制器8，還用於獲取到的控制指令，並判斷控制指令是否為結束指令；如果控制指令是為結束指令時，則保存電角度絕對初始值；如果控制指令不是為結束指令，則執行獲取絕對角位置傳感器的角度值的工作。

具體的，三個軸的穩定環控制量必須有3個無刷電機來執行，在具體實施中，每個無刷電機採用1個功率級控制系統2來驅動，1個功率級控制系統2也可以實現對更多無刷電機的驅動，但是在只有1個功率級控制系統2的情況下，通過驅動3個電機也能實現3軸控制。但是，如果整個系統只有1個電機，那就只能實現1個軸的控制。

如圖1所示，每個軸需要一個功率級控制系統2，每個功率級控制系統都有一個功率級數字控制器，因此三軸雲臺包含3個功率級數字控制器，另外所述功率級數字控制系統2的控制指令可以為根據用戶通過遙控系統或數傳發送的結束命令，該命令也通過多路信息交互接口5接收。

具體的，穩定級數字控制系統1的穩定環控制量為在控制模式為電流閉環模式時功率級數字控制系統2獲取的電流指令或在控制模式為電流開環模式時功率級數字控制系統2獲取的電壓指令，也就是說，在控制模式為電流閉環模式時，獲取到的穩定級數字控制系統1的穩定環控制量為兩相驅動電流值，在控制模式為電流開環模式時，獲取到的穩定級數字控制系統1的穩定環控制量為交軸電壓控制量和直軸電壓控制量。

由於在電流開環模式下進行計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下進行計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功，而且通過根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度，以及根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現得到穩定的高精度圖像。由於無刷電機的驅動控制系統中使用了分布式控制與切實可行的矢量控制相結合的方案，從而能夠更高效地利用電機來提高性能。另外，電機的電流控制採用了矢量控制並且分散到各個功率級數字控制系統進行處理，從而可以減輕了穩定級控制系統的計算壓力。

在具體實施中，所述無刷電機11的數量與穩定雲臺的軸的數量需要一致，即一個無刷電機11控制一個軸，所述功率級數字控制系統2的數量可以與所述無刷電機11的數量相同，那麼功率級數字控制系統2控制一個無刷電機11，當然一個功率級數字控制系統2也可以控制多個個無刷電機11，在本實施例中，一個功率級數字控制系統2控制一個無刷電機11且所述多個功率級數字控制系統2之間的電路結構是相同的。

具體的，如圖8所示，本發明還提供一種實施例的穩定級數字控制系統1包括慣性測量器4，用於檢測得到穩定雲臺的穩定框架的慣性角速度和穩定雲臺的穩定框架的慣性姿態信息；

多路信息交互接口5，分別與所述慣性測量器4和穩定雲臺轉動的控制晶片3連接。

穩定雲臺轉動的控制晶片3，用於自檢穩定雲臺且將穩定雲臺的角度初始化為零；獲取穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的慣性姿態信息，獲取穩定雲臺的穩定框架繞三軸的相對轉動角度；用於根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度；根據所述穩定雲臺的穩定框架的慣性角速度和穩定雲臺的穩定框架的慣性姿態信息進行閉環穩定控制，並輸出穩定環閉環控制指令；根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量並輸出至所述功率級數字控制系統2。

具體的，穩定雲臺轉動的控制晶片3通過並行總線方式與多路信息交互接口5連接。另外，穩定雲臺轉動的控制晶片3可以通過多路信息交互接口5與多個功率級數字控制系統、慣性測量器4進行通信，而且穩定雲臺轉動的控制晶片3是按順序依次與多個功率級數字控制系統通信。所述多路信息交互接口5通信方式包括如下方式：pwm脈寬調製方式，i2c總線方式，spi總線方式，串行通信方式(rs232、rs422、rs485)、can總線方式。

在具體實施中，圖2為本發明多路信息交互接口一種實施例的電路圖。具體的，多路信息交互接口5採用差分數字通信方式，也就是說，多路信息交互接口5包括轉換晶片st16c654和差分晶片max3074，穩定雲臺轉動的控制晶片3通過並行總線方式與轉換晶片st16c654相連，即穩定雲臺轉動的控制晶片3通過數據總線db0-db7和地址總線ab0-ab5連接至轉換晶片st16c654將並行數據轉換成串行數據，穩定雲臺轉動的控制晶片3通過地址總線ab0-ab5與解碼晶片74139連接以選擇需要通信的接口地址。經過轉換晶片st16c654轉換的串行數據在經過差分晶片max3074轉換成差分信號，通過埠ch0-ch3與所述功率級數字控制系統2進行通信。

在具體實施中，圖3為本發明多路信息交互接口另一種實施例的電路圖。具體的，多路信息交互接口5採用模擬量通信方式，也就是說，穩定雲臺轉動的控制晶片3通過並行總線方式與數模轉換晶片ad7656和模數轉換晶片dac8822進行連接，由數模轉換晶片ad7656將數字信息轉換為模擬信息發送給所述功率級數字控制系統2進行通信，外部組件發送的模擬數據由模數轉換晶片dac8822轉換為數字信息發送給穩定雲臺轉動的控制晶片3。

所述慣性測量器4用於測量穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的慣性姿態信息，所述姿態信息包括俯仰數據、橫滾數據和方位數據，並通過多路信息交互接口5將數據發送到穩定雲臺轉動的控制晶片3，其中數據包括角速度和角位置。

在具體實施中，根據所述穩定雲臺包括穩定框架和三軸，所述三軸包括俯仰軸x、橫滾軸y和方位軸z，通過俯仰軸x、橫滾軸y和方位軸z一一對應的無刷電機帶三軸的運動，具體的，通過角傳感器得到穩定雲臺的穩定框架繞三軸的相對轉動角度，而所述穩定雲臺的穩定框架的慣性角速度由陀螺檢測得到。

具體的，穩定雲臺轉動的控制晶片3將穩定環控制量輸出至所述功率級數字控制系統2，所述功率級數字控制系統2根據穩定環控制量控制無刷電機的轉動以帶動無刷電機對應的軸的運動。

在具體實施中，所述穩定閉環控制具體包括超前滯後控制、pid控制和滑模控制的至少其中之一。

在具體實施中，根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度的公式如下：

其中，θ、γ、分別一一對應為穩定雲臺的穩定框架繞三軸的相對轉動角度；[ωpxωpyωpz]t分別一一對應為穩定框架的慣性角速度，[ωbxωbyωbz]t分別一一對應為三軸中每個軸的慣性角速度。

在具體實施中，根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量的公式如下：

其中，uci為穩定環控制量，r為穩定環閉環控制指令的參考值，ω為三軸中其中一個軸的慣性角速度。也就是說根據上述公式，穩定級數字控制系統1得到對於單個功率級數字控制系統2的穩定環控制量，通過多路信息交互接口5發送給對應的功率級數字控制系統2以實現對無刷電機的控制。另外，穩定環閉環控制指令根據工作模式的不同而生成不同的控制指令，如果是穩定模式，穩定環閉環控制指令為通過數傳接收到的角速度命令；如果是跟蹤該模式，穩定環閉環控制指令為根據圖像脫靶量計算得到的控制量即跟蹤閉環控制量。

通過根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度，以及根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現得到穩定的高精度圖像。另外，所述穩定級控制系統只需要進行穩定環控制量的計算而不需要對電機進行驅動控制，從而可以減輕穩定級控制系統的計算量。

在具體實施中，穩定級數字控制系統1還包括圖像追蹤器6，用於檢測並獲取被跟蹤目標相對圖像畫面中心的脫靶量；多路信息交互接口5，分別與圖像追蹤器6和穩定雲臺轉動的控制晶片3連接；穩定雲臺轉動的控制晶片3，還用於自檢穩定雲臺且將穩定雲臺的角度初始化為零；獲取被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量，將跟蹤閉環控制量作為穩定環閉環控制指令，根據反饋數據做穩定閉環控制，將計算得到的穩定環控制量並輸出。

在具體實施中，所述根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，得到穩定雲臺的三軸中每個軸的角度差值的公式如下：

θ＝arctan(n×psize/l)；

其中θ為角度差，n為脫靶量，psize為像元尺寸，l為焦距。

在具體實施中，所述根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量的公式如下：

其中uci為跟蹤閉環控制量，θi為三軸中每個軸的角度差值。

在具體實施中，將跟蹤閉環控制量作為穩定環控制指令以進行閉環穩定控制得到的穩定環控制量的具體公式為本領域的公知常識。

通過根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，得到穩定雲臺的三軸中每個軸的角度差值，以及所述根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量，將跟蹤閉環控制量作為穩定環閉環控制指令以得到計算穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現對圖像進行持續跟蹤拍攝。因此可以實現高精度的圖像穩定以及在移動航拍過程中對運動目標的穩定、持續跟蹤拍攝的目的。所述穩定級控制系統只需要進行穩定環控制量的計算而不需要對電機進行驅動控制，從而可以減輕穩定級控制系統的計算量。

在具體實施中，如圖7所示，本發明提供一種實施例的功率級數字控制系統2用於對電機的轉動矢量進行控制，在具體實施中，本發明提供一種實施例的功率級數字控制系統2用於控制電機轉動，所述功率級數字控制系統2包括：

通信接口7，用於接收功率級控制器的當前的工作模式和控制指令；

功率級控制器8，用於判斷當前是否存在電角度絕對初始值；如果不存在電角度絕對初始值時，在初始化模式下得到當前的電角度值、交軸電壓控制量、直軸電壓控制量和電角度絕對初始值；如果存在電角度絕對初始值時，獲取絕對角位置傳感器的角度值，根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值，以及得到所述交軸電壓控制量和直軸電壓控制量；根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動；

三相橋驅動器9，用於根據功率級控制器輸出的pwm的佔空比輸出驅動電流以控制電機的轉動；

電流傳感器10，用於檢測三相橋驅動器的驅動電流中的兩相驅動電流值；

絕對角位置傳感器12，用於檢測電機的角度值。

在具體實施中，所述功率級控制器8，還用於獲取當前的工作模式，並判斷當前的工作模式為電流開環模式或者電流閉環模式；

當前的工作模式為電流閉環模式，根據獲取到兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量；

當前的工作模式為電流開環模式，獲取交軸電壓控制量和直軸電壓控制量。

在具體實施中，所述功率級控制器8，還用於獲取到的控制指令，並判斷控制指令是否為結束指令；如果控制指令是為結束指令時，則保存電角度絕對初始值；如果控制指令不是為結束指令，則執行獲取絕對角位置傳感器的角度值的工作。

具體的，電機為無刷電機11，所述通信接口7是功率級數字控制系統2與外界通信接口，採用通信方式與穩定級數字控制系統相對應。所述功率級控制器8讀取所述絕對角位置傳感器12和電流傳感器10的兩相驅動電流數據，獲得所述無刷電機11轉子相對於定子的絕對角位置以及無刷電機相鄰兩相的電流數據，運行矢量控制算法，並將計算得到的結果通過所述功率級控制器8上的3組pwm模塊輸出給三相橋驅動組件9。所述三相橋驅動組件9提供abc三相接口可與無刷電機11三相進行電氣連接；在電氣裝聯時，無刷電機三相連線為三根導線，可選擇任意一根與所述功率晶片的a相相連，無刷電機其餘兩根導線選擇與已連接導線相鄰的一根作為b相，其餘一根與c相相連。所述三相橋驅動組件9與無刷電機11電氣連接，驅動無刷電機11轉動，從而帶動穩定雲臺轉動。

也就是說，所述功率級數字控制系統2可以實現以下三部分功能：初始電角度對準、磁場定向控制、電流閉環和電流開環模式的判斷和選通程序；所述電流閉環和電流開環模式的判斷和選通程序根據接收到的數據將系統設置為電流閉環模式或電流開環模式；所述磁場定向控制利用絕對角位置傳感器和兩相電流數據進行矢量運算，在電流閉環模式下的無刷電機交軸控制指令為接收到的數據，直軸控制指令為零，分別計算得到交軸電壓控制量和直軸電壓控制量；在電流開環模式下，交軸電壓控制量為直接接收到的數據，直軸電壓控制量為零。其中，所述矢量控制算法中的電角度絕對初始值對準程序將系統工作在電流閉環模式下，通過對交軸電流和直軸電流進行控制，將電角度強制設置為-π/2，並讀取此時絕對角位置傳感器讀數以實現電角度的對準，從而通過程序實現初始角度對準，那麼安裝時對於電機的相位要求便更加隨意。另外，在電流開環模式下計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功。

在具體實施中，所述功率級控制器8還用於：

將兩相驅動電流值設置為第一預設電流值和第二預設電流值；

根據兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量；

將當前的電角度設置為預設的角度值；

獲取絕對角位置傳感器的角度值，並根據絕對角位置傳感器的角度值和當前的電角度得到電角度絕對初始值。

具體的，當電角度絕對初始值不存在時，也就是說，需要計算電角度絕對初始值時，需要將兩相驅動電流值強制設定為第一預設電流值icmdq0和第二預設電流值icmdd0，預設的角度值為-π/2，採集絕對角位置傳感器的角度值作為電角度絕對初始值，並進行存儲。由於電機在未設定電角度絕對初始值時是不知道電角度-π/2所對應的電機絕對角位置，初始化就是將兩者對應，在電機安裝在結構組件上時需要將電角度設定為-π/2，此時讀取絕對角位置傳感器的角度值，並將該角度值記錄存儲作為電角度絕對初始值，即將當前的電角度和電角度絕對初始值進行對應。

在具體實施中，所述功率級控制器8還用於：

根據獲取到兩相驅動電流值進行clarke變換得到第一變換電流值和第二變換電流值；

根據第一變換電流值和第二變換電流值進行park變換得到交軸電流值和直軸電流值；

根據所述交軸電流值和直軸電流值得到交軸電壓控制量和直軸電壓控制量。

在具體實施中，兩相驅動電流值為a相的驅動電流值ia和b相的驅動電流值ib，根據a相的驅動電流值ia和b相的驅動電流值ib進行clarke變換得到第一變換電流值iα和第二變換電流值iβ的公式如下：

根據第一變換電流值iα和第二變換電流值iβ進行park變換得到交軸電流值iq和直軸電流值id的公式如下：

其中θ表示電角度數值。

具體的，當設計控制器為比例積分控制時，根據所述交軸電流值iq和直軸電流值id得到交軸電壓控制量vq和直軸電壓控制量vd計算公式如下：

其中，和表示電流指令，kp為比例係數；ki為積分增益。具體的，電流指令就是穩定級控制系統通過多路信息交互接口發送給功率級數字控制系統的電流控制量；電流指令通常在功率級數字控制系統中設置為0，即令全部電流參與做功，另外電流控制量就是穩定級控制系統在跟蹤模式下或穩定模式下輸出的穩定環控制量。

在具體實施中，所述功率級控制器8還用於：

根據交軸電壓控制量和直軸電壓控制量進行park逆變換得到三相電壓va、vb和vc；

根據三相電壓va、vb和vc得到輸出pwm的佔空比以控制電機的轉動。

具體的，根據交軸電壓控制量vq和直軸電壓控制量vd進行park逆變換得到三相電壓va、vb和vc的公式如下：

在具體實施中，所述根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值的步驟，具體為：

當前的電角度值等於所述絕對角位置傳感器的角度值減去電角度絕對初始值後換算為弧度再乘以極對數。

所述根據絕對角位置傳感器的角度值和當前的電角度得到電角度絕對初始值的步驟，具體為：

電角度絕對初始值等於所述絕對角位置傳感器的角度值。

也就是說，電角度絕對初始值為進行電角度初始值設定過程中讀取並記錄的絕對角位置傳感器的數值，在不需要計算電角度初始值的時候，直接讀取之前記錄的。

本發明還提供一種實施例的穩定雲臺，所述穩定雲臺包括上述的功率級數字控制系統2。

本發明的穩定雲臺，在電流開環模式下進行計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下進行計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功。

在具體實施中，如圖4所示，功率級控制器8具體為tm32028069晶片，所述三相橋驅動組件9包括三個開關管模塊，每個開關管模塊包括一個三極體、第一電阻r1、第二電阻r2、第三電阻r3、第四電阻r4、第一mos管na1和第二mos管na2，所述tm32028069晶片的第一輸出埠pwma1和第二輸出埠pwma2連接其中一個開關管模塊。具體的，所述tm32028069晶片的第一輸出埠pwma1與第二電阻r2的一端連接，第二電阻r2的另一端與三極體的基極連接，所述tm32028069晶片的第二輸出埠pwma2與第三電阻r3的一端連接，第三電阻r3的另一端分別與第二mos管na2的第一端和第四電阻r4的一端連接，第二mos管na2的第二端和第四電阻r4的另一端均接地，電源vcc分別與第五電阻r5的一端與第一mos管na1的第三端連接，三極體的集電極分別與第五電阻r5的另一端和第一mos管na1的第一端連接，第一mos管na1的第二端與第二mos管na2的第三端連接，三極體的發射極接地，第一mos管na1的第二端與第二mos管na2的第三端連接形成一個信號節點用於輸出其中一個三相驅動信號，也就是三個開關管模塊輸出三相驅動信號phasha、phashb、phashc，電流傳感器10檢測驅動信號phasha、phashb，並將檢測到的測量值輸出至所述tm32028069晶片。

在具體實施中，如圖5所示，所述三相橋驅動組件9包括三個邏輯門電路晶片u1a、u1b、u1c和三相橋驅動晶片，具體的，三相橋驅動晶片具體為drv8312驅動晶片。功率級控制器8具體為tm32028069晶片，所述tm32028069晶片的第一輸出埠pwma1和第二輸出埠pwma2分別與邏輯門電路晶片u1a的第一輸入端和第二輸入端連接，所述tm32028069晶片的第一輸出埠pwma1還與drv8312驅動晶片的第一輸入端pwma連接，邏輯門電路晶片u1a的輸出端與drv8312驅動晶片的第二輸入端reset_a連接，所述tm32028069晶片的第三輸出埠pwmb1和第四輸出埠pwmb2分別與邏輯門電路晶片u1b的第三輸入端和第四輸入端連接，所述tm32028069晶片的第三輸出埠pwmb1還與drv8312驅動晶片的第三輸入端pwmb連接，邏輯門電路晶片u1b的輸出端與drv8312驅動晶片的第四輸入端reset_b連接，所述tm32028069晶片的第五輸出埠pwmc1和第六輸出埠pwmc2分別與邏輯門電路晶片u1c的第一輸入端和第二輸入端連接，所述tm32028069晶片的第五輸出埠pwmc1還與drv8312驅動晶片的第五輸入端pwmc連接，邏輯門電路晶片u1c的第一輸出端與drv8312驅動晶片的第六輸入端reset_c連接，所述drv8312驅動晶片輸出三相驅動信號phasha、phashb、phashc，電流傳感器10檢測驅動信號phasha、phashb，並將檢測到的測量值輸出至所述tm32028069晶片。

具體的，如圖6(a)所示，開關管v1和開關管v4構成同一橋臂且開關管v1和開關管v4之間具有第一節點，開關管v3和開關管v6構成同一橋臂且開關管v3和開關管v6之間具有第二節點，開關管v2和開關管v5構成同一橋臂且開關管v2和開關管v5之間具有第二節點，通過防止開關管v1和開關管v4的同時導通、防止開關管v3和開關管v6的同時導通或者防止開關管v2和開關管v5的同時導通，從而防止所述三相橋驅動晶片出現同一橋臂兩個功率管同時導通造成短路，其中，所述三相橋驅動晶片的第一節點連接無刷電機11的a相，所述三相橋驅動晶片的第二節點連接無刷電機11的b相，所述三相橋驅動晶片的第三節點連接無刷電機11的c相。如圖6(b)所示，所述三相橋驅動晶片的第一節點連接無刷電機11的b相，所述三相橋驅動晶片的第二節點連接無刷電機11的c相，所述三相橋驅動晶片的第三節點連接無刷電機11的a相。如圖6(c)所示，所述三相橋驅動晶片的第一節點連接無刷電機11的c相，所述三相橋驅動晶片的第二節點連接無刷電機11的a相，所述三相橋驅動晶片的第三節點連接無刷電機11的b相。

也就是說，所述三相橋驅動組件9提供abc三相接口可與無刷電機11三相進行電氣連接；在電氣裝聯時，無刷電機11的a相、b相及c相三相連線為三根導線，可選擇任意一根與所述三相橋驅動組件9的其中一個節點相連，無刷電機其餘兩根導線選擇與所述三相橋驅動組件9的另外兩個節點一一對應連接。另外，所述三相橋驅動組件9與無刷電機11電氣連接，驅動無刷電機轉動，從而帶動穩定雲臺的轉動。

在具體實施中，所述絕對角位置傳感器12具體為磁編碼器、增量式編碼器、絕對實編碼器的其中一種。

本發明還提供一種實施例的穩定雲臺，包括上述的無刷電機的驅動控制系統和與所述驅動控制系統對應連接的無刷電機11。

本發明提供一種實施例的用於控制電機轉動的矢量控制方法，所述矢量控制方法包括以下步驟：

判斷當前是否存在電角度絕對初始值；

如果不存在電角度絕對初始值時，在初始化模式下得到當前的電角度值、交軸電壓控制量、直軸電壓控制量和電角度絕對初始值；

如果存在電角度絕對初始值時，獲取絕對角位置傳感器的角度值，根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值，以及得到所述交軸電壓控制量和直軸電壓控制量；

根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動。

在具體實施中，所述得到所述交軸電壓控制量和直軸電壓控制量的步驟，包括以下步驟：

獲取當前的工作模式，並判斷當前的工作模式是否為電流開環模式或者電流閉環模式；

當前的工作模式為電流閉環模式，根據獲取到兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量，進入根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動的步驟；

當前的工作模式為電流開環模式，獲取得到交軸電壓控制量和直軸電壓控制量，進入根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動的步驟。

在具體實施中，所述矢量控制方法包括以下步驟：

獲取到的控制指令，並判斷控制指令是否為結束指令；

如果是，則保存電角度絕對初始值；

如果否，則返回獲取絕對角位置傳感器的角度值的步驟。

在具體實施中，如圖9所示，本發明提供一種實施例的用於控制電機轉動的矢量控制方法，所述矢量控制方法包括：

步驟s11，判斷當前是否存在電角度絕對初始值，如果否，進入步驟s12，如果是，進入步驟s13；

步驟s12，在初始化模式下得到當前的電角度值、交軸電壓控制量、直軸電壓控制量和電角度絕對初始值，進入步驟s17；

步驟s13，獲取絕對角位置傳感器的角度值；

步驟s14，獲取當前的工作模式，並判斷當前的工作模式是否為電流開環模式，如果是，進入步驟s15，如果否，進入步驟s16；

步驟s15，獲取交軸電壓控制量和直軸電壓控制量，進入步驟s17；

步驟s16，根據獲取到兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量，進入步驟s17；

步驟s17，根據當前的電角度值、交軸電壓控制量和直軸電壓控制量得到輸出pwm的佔空比以控制電機的轉動；

步驟s18，獲取到的控制指令，並判斷控制指令是否為結束指令，如果是，進入步驟s19，如果否，則進入s13；

步驟s19，保存電角度絕對初始值。

在步驟s14中，也可以是，判斷當前的工作模式是否為電流閉環模式，如果否，進入步驟s15，如果是，進入步驟s16。

從上述步驟，可以看出所述矢量控制算法包括初始電角度對準、磁場定向控制、電流閉環和電流開環模式的判斷和選通程序三部分組成；所述電流閉環和電流開環模式的判斷和選通程序根據接收到的數據將系統設置為電流閉環模式或電流開環模式；所述磁場定向控制利用絕對角位置傳感器和兩相電流數據進行矢量運算，在電流閉環模式下的無刷電機交軸控制指令為接收到的數據，直軸控制指令為零，分別計算得到交軸電壓控制量和直軸電壓控制量；在電流開環模式下，交軸電壓控制量為直接接收到的數據，直軸電壓控制量為零。其中，所述矢量控制算法中的電角度絕對初始值對準程序將系統工作在電流閉環模式下，通過對交軸電流和直軸電流進行控制，將電角度強制設置為-π/2，並讀取此時絕對角位置傳感器讀數以實現電角度的對準，從而通過程序實現初始角度對準，那麼安裝時對於電機的相位要求便更加隨意。另外，在電流開環模式下進行計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下進行計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功。

在具體實施中，如圖10所示，步驟s12，具體包括以下步驟：

步驟s121，將兩相驅動電流值設置為第一預設電流值和第二預設電流值；

步驟s122，根據兩相驅動電流值得到交軸電壓控制量和直軸電壓控制量；

步驟s123，將當前的電角度設置為預設的角度值；

步驟s124，獲取絕對角位置傳感器的角度值，並根據絕對角位置傳感器的角度值和當前的電角度得到電角度絕對初始值。

具體的，當電角度絕對初始值不存在時，也就是說，需要計算電角度絕對初始值時，需要將兩相驅動電流值強制設定為第一預設電流值icmdq0和第二預設電流值icmdd0，預設的角度值為-π/2，採集絕對角位置傳感器的角度值作為電角度絕對初始值，並進行存儲。由於電機在未設定電角度絕對初始值時是不知道電角度-π/2所對應的電機絕對角位置，初始化就是將兩者對應，在電機安裝在結構組件上時需要將電角度設定為-π/2，此時讀取絕對角位置傳感器的角度值，並將該角度值記錄存儲作為電角度絕對初始值，即將當前的電角度和電角度絕對初始值進行對應。

在步驟s122，根據兩相驅動電流值，在電流閉環控制下得到交軸電壓控制量和直軸電壓控制量。

在具體實施中，如圖11所示，步驟s122或者步驟s16，具體包括：

步驟s31，根據獲取到兩相驅動電流值進行clarke變換得到第一變換電流值和第二變換電流值；

步驟s32，根據第一變換電流值和第二變換電流值進行park變換得到交軸電流值和直軸電流值；

步驟s33，根據所述交軸電流值和直軸電流值得到交軸電壓控制量和直軸電壓控制量。

在具體實施中，兩相驅動電流值為a相的驅動電流值ia和b相的驅動電流值ib，根據a相的驅動電流值ia和b相的驅動電流值ib進行clarke變換得到第一變換電流值iα和第二變換電流值iβ的公式如下：

根據第一變換電流值iα和第二變換電流值iβ進行park變換得到交軸電流值iq和直軸電流值id的公式如下：

其中θ表示電角度數值。

具體的，當設計控制器為比例積分控制時，根據所述交軸電流值iq和直軸電流值id得到交軸電壓控制量vq和直軸電壓控制量vd計算公式如下：

其中，和表示電流指令，kp為比例係數；ki為積分增益。

具體的，電流指令就是穩定級控制系統通過多路信息交互接口發送給功率級數字控制系統的電流控制量；電流指令通常在功率級數字控制系統中設置為0，即令全部電流參與做功，另外電流控制量就是穩定級控制系統在跟蹤模式下或穩定模式下輸出的穩定環控制量。

在具體實施中，如圖12所示，步驟s17具體包括以下步驟：

步驟s41，根據交軸電壓控制量和直軸電壓控制量進行park逆變換最終得到三相電壓va、vb和vc；

步驟s42，根據三相電壓va、vb和vc得到輸出pwm的佔空比以控制電機的轉動。

具體的，根據交軸電壓控制量vq和直軸電壓控制量vd進行park逆變換最終得到三相電壓va、vb和vc的公式如下：

在具體實施中，所述根據所述絕對角位置傳感器的角度值和電角度絕對初始值得到當前的電角度值的步驟，具體為：

當前的電角度值等於所述絕對角位置傳感器的角度值減去電角度絕對初始值後換算為弧度再乘以極對數。

所述根據絕對角位置傳感器的角度值和當前的電角度得到電角度絕對初始值的步驟，具體為：

電角度絕對初始值等於所述絕對角位置傳感器的角度值。

也就是說，電角度絕對初始值為進行電角度初始值設定過程中讀取並記錄的絕對角位置傳感器的數值，在不需要計算電角度初始值的時候，直接讀取之前記錄的。

本發明還提供一種實施例的計算機可讀存儲介質，其上存儲有電腦程式，該程序被處理器執行時實現上述圖9-12所示的方法的步驟。

本發明的計算機可讀存儲介質，在電流開環模式下進行計算，可以減小處理器的壓力，當選用性能較低的處理器時，由於處理器計算能力弱，無法在規定的時間周期內完成電流閉環算法的計算，可以在電流開環模式下計算，而在電流閉環模式下進行計算，可以有效的消除電機感應電動勢的影響，使力矩輸出更加平穩，同時也能使流過電機的電流都可以有效地參與做功。

本發明還提供一種實施例的穩定雲臺轉動的控制方法，如圖13所示，所述矢量控制方法包括：

步驟s211，自檢穩定雲臺且穩定雲臺的角度初始化為零；

步驟s212，獲取穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的慣性姿態信息；

步驟s213，獲取穩定雲臺的穩定框架繞三軸的相對轉動角度；

步驟s214，根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度；

步驟s215，根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量並輸出以控制所述穩定雲臺的三軸運動；

步驟s216，限位診斷；

步驟s217，根據獲取到穩定雲臺的控制指令判斷是否結束，如果是進入步驟s218，如果否，返回步驟s212；

步驟s218，保存變量。

在步驟s215中，穩定環控制量輸出至所述功率級數字控制系統，所述功率級數字控制系統根據穩定環控制量控制無刷電機的轉動以帶動無刷電機對應的軸的運動。

在步驟s216中，由於穩定雲臺的轉動範圍是有限的，在程序中對雲臺轉動情況加以監視，如果穩定雲臺轉動達到預先設定的範圍邊界時對雲臺的控制量加以限制，保證雲臺不會「撞擊」或「卡死」。

在具體實施中，所述穩定雲臺的穩定框架的慣性姿態信息包括俯仰數據、橫滾數據和方位數據，數據包括角速度和角位置。

在具體實施中，所述穩定閉環控制具體包括超前滯後控制、pid控制和滑模控制的至少其中之一。

在具體實施中，根據所述穩定雲臺包括穩定框架和三軸，所述三軸包括俯仰軸x、橫滾軸y和方位軸z，通過俯仰軸x、橫滾軸y和方位軸z一一對應的無刷電機帶三軸的運動，具體的，通過角傳感器得到穩定雲臺的穩定框架繞三軸的相對轉動角度，而所述穩定雲臺的穩定框架的慣性角速度由陀螺檢測得到。

在具體實施中，根據所述穩定雲臺的的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度的公式如下：

其中，θ、γ、分別一一對應為穩定雲臺的穩定框架繞三軸的相對轉動角度；[ωpxωpyωpz]t為三軸中每個軸的慣性角速度，[ωbxωbyωbz]t分別一一對應為三軸中每個軸的慣性角速度。

在具體實施中，根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量的公式如下：

其中，uci為穩定環控制量，r為穩定環閉環控制指令的參考值，ω為三軸中其中一個軸的角速度。也就是說根據上述公式，穩定級數字控制系統得到對於單個功率級數字控制系統的穩定環控制量通過多路信息交互接口發送給對應的功率級數字控制系統2以實現對無刷電機的控制。另外，穩定環閉環控制指令根據工作模式的不同而生成不同的控制指令，如果是穩定模式，穩定環閉環控制指令為通過數傳接收到的角速度命令；如果是跟蹤該模式，穩定環閉環控制指令為根據圖像脫靶量計算得到的控制量即跟蹤閉環控制量。

通過根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度，以及根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現得到穩定的高精度圖像。另外，所述穩定級控制系統只需要進行穩定環控制量的計算而不需要對電機進行驅動控制，從而可以減輕穩定級控制系統的計算量。

本發明還提供一種實施例的計算機可讀存儲介質，其上存儲有電腦程式，該程序被處理器執行時實現上述圖13的方法的步驟。

通過根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度，以及根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現得到穩定的高精度圖像。另外，所述穩定級控制系統只需要進行穩定環控制量的計算而不需要對電機進行驅動控制，從而可以減輕穩定級控制系統的計算量。

本發明還提供一種實施例的穩定雲臺轉動的控制方法，如圖14所示，所述控制方法包括：

步驟s311，自檢穩定雲臺且穩定雲臺的角度初始化為零；

步驟s312，獲取被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值；

步驟s313，根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，得到穩定雲臺的三軸中每個軸的角度差值；

步驟s314，根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量；

步驟s315，將跟蹤閉環控制量作為穩定環控制指令以進行閉環穩定控制得到穩定環控制量，將計算得到的穩定環控制量並輸出以控制所述穩定雲臺的三軸運動；

步驟s316，限位診斷；

步驟s317，根據獲取到穩定雲臺的控制指令判斷是否結束，如果是進入步驟s319，如果否，返回步驟s312；

步驟s318，保存變量。

在步驟s315中，穩定環控制量輸出至所述功率級數字控制系統，所述功率級數字控制系統根據穩定環控制量控制無刷電機的轉動以帶動無刷電機對應的軸的運動。

在步驟s316中，由於穩定雲臺的轉動範圍是有限的，在程序中對雲臺轉動情況加以監視，如果穩定雲臺轉動達到預先設定的範圍邊界時對雲臺的控制量加以限制，保證雲臺不會「撞擊」或「卡死」。

在具體實施中，在步驟s311之後，如圖15所示，還包括以下步驟：

步驟s420，判斷預設的控制模式是否為圖像跟蹤模式，如果是，進入步驟s421，如果否，進入步驟s422；

步驟s421，進入圖像跟蹤模式，進入步驟s312；

步驟s422，進入圖像穩定模式，進入步驟423；

步驟s423，獲取穩定雲臺的穩定框架的慣性角速度以及穩定雲臺的穩定框架的姿態信息；

步驟s424，獲取穩定雲臺繞三軸的相對轉動角度；

步驟s425，根據所述穩定雲臺的穩定框架的慣性角速度、穩定雲臺的穩定框架的姿態信息以及穩定雲臺繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度；

步驟s426，根據三軸中每個軸的慣性角速度和控制指令參考值，得到穩定環控制量並輸出以控制所述穩定雲臺的三軸運動，進入步驟s316。

在圖15中，步驟s317，判斷是否結束，如果是進入步驟s319，如果否，返回步驟s420。

在步驟s426中，穩定環控制量輸出至所述功率級數字控制系統，所述功率級數字控制系統根據穩定環控制量控制無刷電機的轉動以帶動無刷電機對應的軸的運動。

在具體實施中，所述穩定雲臺的穩定框架的慣性姿態信息包括俯仰數據、橫滾數據和方位數據，數據包括角速度和角位置。

在具體實施中，所述穩定閉環控制具體包括超前滯後控制、pid控制和滑模控制的至少其中之一。

在具體實施中，根據所述穩定雲臺包括穩定框架和三軸，所述三軸包括俯仰軸x、橫滾軸y和方位軸z，通過俯仰軸x、橫滾軸y和方位軸z一一對應的無刷電機帶三軸的運動，具體的，通過角傳感器得到穩定雲臺的穩定框架繞三軸的相對轉動角度，而所述穩定雲臺的穩定框架的慣性角速度由陀螺檢測得到。

在具體實施中，根據所述穩定雲臺的的穩定框架的慣性角速度、穩定雲臺的穩定框架的慣性姿態信息以及穩定雲臺的穩定框架繞三軸的相對轉動角度，得到三軸中每個軸的慣性角速度的公式如下：

其中，θ、γ、分別一一對應為穩定雲臺的穩定框架繞三軸的相對轉動角度；[ωpxωpyωpz]t分別一一對應為穩定框架的慣性角速度，[ωbxωbyωbz]t分別一一對應為三軸中每個軸的慣性角速度。

在具體實施中，根據三軸中每個軸的慣性角速度和穩定環閉環控制指令的參考值，得到穩定環控制量的公式如下：

其中，uci為穩定環控制量，r為穩定環閉環控制指令的參考值，ω為三軸中其中一個軸的角速度。也就是說根據上述公式，穩定級數字控制系統得到對於單個功率級數字控制系統的穩定環控制量通過多路信息交互接口發送給對應的功率級數字控制系統2以實現對無刷電機的控制。另外，穩定環閉環控制指令根據工作模式的不同而生成不同的控制指令，如果是穩定模式，穩定環閉環控制指令為通過數傳接收到的角速度命令；如果是跟蹤該模式，穩定環閉環控制指令為根據圖像脫靶量計算得到的控制量即跟蹤閉環控制量。

在具體實施中，所述根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，得到穩定雲臺的三軸中每個軸的角度差值的公式如下：

θ＝arctan(n×psize/l)

其中θ為角度差，n為脫靶量，psize為像元尺寸，l為焦距。

在具體實施中，所述根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量的公式如下：

其中uci為跟蹤閉環控制量，θi為三軸中每個軸的角度差值。

在具體實施中，將跟蹤閉環控制量作為穩定環控制指令以進行閉環穩定控制得到的穩定環控制量的具體公式為本領域的公知常識。

通過根據被跟蹤目標相對圖像畫面中心的脫靶量以及相機的焦距值，得到穩定雲臺的三軸中每個軸的角度差值，以及所述根據穩定雲臺的三軸中每個軸的角度差值得到跟蹤閉環控制量以得到穩定環控制量，將穩定環控制量輸出至功率級數字控制系統，通過功率級數字控制系統控制無刷電機的轉動以控制穩定雲臺的各個軸的運動，從而實現對圖像進行持續跟蹤拍攝。另外，所述穩定級控制系統只需要進行跟蹤閉環控制量的計算而不需要對電機進行驅動控制，從而可以減輕穩定級控制系統的計算量。

本發明還提供一種實施例的計算機可讀存儲介質，其上存儲有電腦程式，該程序被處理器執行時實現上述圖14-15的方法的步驟。

本發明還提供一種實施例的無刷電機的驅動控制方法，可以包括圖13、圖14和圖15的其中一個方法加上圖9-12所示的方法。

本發明還提供一種實施例的計算機可讀存儲介質，其上存儲有電腦程式，該程序被處理器執行時實現上述圖13、圖14和圖15的其中一個方法加上圖9-12所示的方法的步驟。

上述實施例和說明書中描述的只是說明本發明的原理和最佳實施例，在不脫離本發明精神和範圍的前提下，本發明還會有各種變化和改進，這些變化和改進都落入要求保護的本發明範圍內。