[發(fā)明專利]飛輪底座水平度控制系統(tǒng)和方法

在審

• 申請?zhí)枺?/td>: 202110985943.4
• 申請日: 2021-08-26
• 公開（公告）號: CN113687618A
• 公開（公告）日: 2021-11-23
• 發(fā)明（設(shè)計）人: 李樹勝;王佳良;李光軍;汪大春
• 申請（專利權(quán)）人: 北京泓慧國際能源技術(shù)發(fā)展有限公司
• 主分類號: G05B19/042
• 分類號: G05B19/042
• 代理公司: 北京超凡宏宇專利代理事務(wù)所(特殊普通合伙) 11463
• 代理人: 徐麗

1.一種飛輪底座水平度控制系統(tǒng)，其特征在于，所述系統(tǒng)包括：DSP處理器、傾角傳感器、飛輪底座、電機組和上位機，所述電機組包括多個電機；

所述傾角傳感器、所述電機組和所述上位機分別與所述DSP處理器相連接，所述電機組和所述傾角傳感器分別與所述飛輪底座相連接；

所述傾角傳感器，用于采集所述飛輪底座在水平方向的兩個坐標軸上的角度信息，將所述角度信息發(fā)送給所述DSP處理器；

所述DSP處理器，用于根據(jù)所述角度信息得到第一角度值和第二角度值；根據(jù)所述第一角度值和所述第二角度值確定所述電機的初始基準點；接收所述上位機發(fā)送的調(diào)平指令；根據(jù)所述調(diào)平指令和所述電機的初始基準點確定每個電機的調(diào)平位置。

2.根據(jù)權(quán)利要求1所述的飛輪底座水平度控制系統(tǒng)，其特征在于，所述DSP處理器，用于當所述第一角度值大于0，且所述第二角度值大于0時，將第一電機作為所述初始基準點；當所述第一角度值大于0，且所述第二角度值小于0時，將第三電機作為所述初始基準點；當所述第一角度值小于0，且所述第二角度值大于0時，將第二電機作為所述初始基準點；當所述第一角度值小于0，且所述第二角度值小于0時，將第四電機作為所述初始基準點。

3.根據(jù)權(quán)利要求1所述的飛輪底座水平度控制系統(tǒng)，其特征在于，所述DSP處理器，用于根據(jù)所述初始基準點進行X水平度調(diào)節(jié)，自鎖第一電機和第三電機；再進行Y水平度調(diào)節(jié)，自鎖第二電機和第四電機。

4.根據(jù)權(quán)利要求3所述的飛輪底座水平度控制系統(tǒng)，其特征在于，所述DSP處理器，用于當所述第一電機為所述初始基準點時，所述第一電機的調(diào)平位置為當前位置；如果所述當前位置滿足期望調(diào)平位置，則將所述第一電機自鎖；

將所述第三電機和所述第四電機進行X水平度調(diào)節(jié)，當所述飛輪底座在X軸的水平度達到調(diào)平精度要求時，將所述第三電機自鎖；

將所述第二電機和所述第四電機進行Y水平度調(diào)節(jié)，當所述飛輪底座在Y軸的水平度達到所述調(diào)平精度要求時，將所述第二電機和所述第四電機自鎖。

5.根據(jù)權(quán)利要求1所述的飛輪底座水平度控制系統(tǒng)，其特征在于，所述系統(tǒng)還包括CAN總線；

所述CAN總線，用于接收所述上位機發(fā)送的指令信息和參數(shù)設(shè)置信息；

其中，所述指令信息包括啟動指令、停機指令和調(diào)平指令，所述參數(shù)設(shè)置信息包括PID設(shè)置參數(shù)、水平度調(diào)節(jié)量和電機系統(tǒng)保護參數(shù)。

6.根據(jù)權(quán)利要求1所述的飛輪底座水平度控制系統(tǒng)，其特征在于，所述系統(tǒng)還包括功率放大器和電流傳感器，所述功率放大器包括IGBT；

所述功率放大器，分別與所述DSP處理器、所述電流傳感器和所述電機相連接，用于將所述DSP處理器發(fā)送的控制信號轉(zhuǎn)化為功率開關(guān)信號，通過所述功率開關(guān)信號驅(qū)動所述IGBT的開通和斷開，從而控制所述電機；

所述電流傳感器，用于采集所述電機的電流信息；

所述DSP處理器，用于根據(jù)所述電流信息控制所述電機的電流參量。

7.一種飛輪底座水平度控制方法，其特征在于，應(yīng)用于權(quán)利要求1至6任一項所述的飛輪底座水平度控制系統(tǒng)，所述飛輪底座水平度控制系統(tǒng)包括DSP處理器、傾角傳感器、飛輪底座、電機組和上位機，所述電機組包括多個電機；所述方法包括：

所述傾角傳感器采集所述飛輪底座在水平方向的兩個坐標軸上的角度信息，將所述角度信息發(fā)送給所述DSP處理器；

所述DSP處理器根據(jù)所述角度信息得到第一角度值和第二角度值；

所述DSP處理器根據(jù)所述第一角度值和所述第二角度值確定所述電機的初始基準點；

所述DSP處理器接收所述上位機發(fā)送的調(diào)平指令；

所述DSP處理器根據(jù)所述調(diào)平指令和所述電機的初始基準點確定每個電機的調(diào)平位置。