[發明專利]一種用于工程車的傾動裝置控制器

無效

• 申請號: 201110326645.0
• 申請日: 2011-10-25
• 公開（公告）號: CN102426433A
• 公開（公告）日: 2012-04-25
• 發明（設計）人: 周鳳星;蘭建武;郭航宇;梅志堅
• 申請（專利權）人: 武漢科技大學
• 主分類號: G05B19/042
• 分類號: G05B19/042
• 代理公司: 武漢科皓知識產權代理事務所(特殊普通合伙) 42222
• 代理人: 張火春

1.一種用于工程車的傾動裝置控制器，其特征在于復位電路[1]的輸出端與單片機[5]的RST引腳連接，時鐘電路[2]的12M晶振的兩個端口與單片機[5]的XTAL2、XTAL1引腳對應連接，光報警電路[3]的輸出端與單片機[5]的P11端口連接，聲音報警電路[4]的輸出端與單片機[5]的P10端口連接，按鍵[9]的6條線與單片機[5]的端口P20~P25對應連接，定位開關[10]的輸出端與單片機[5]的P26端口連接；單片機[5]的P00~P06端口與步進電機驅動芯片[6]的CK1、CK2、CW、ENABLE、M1、M2、REFIN端口對應連接，步進電機驅動芯片[6]的ΦA、Ф????????????????????????????????????????????????、ΦB、Φ端口與步進電機[7]的線圈A+、A-、B+、B-對應連接，步進電機[7]的輸出軸通過絲桿與液壓閥[8]的閥芯連接；

主程序模塊、脈沖產生程序模塊、按鍵功能程序模塊、閥芯移動程序模塊、誤差調整程序模塊、故障報警程序模塊和閥芯復位程序模塊寫入單片機[5]的內部存儲器。

2.根據權利要求1所述的用于工程車的傾動裝置控制器，其特征在于所述的主程序模塊的程序流程是：

S1-1、步進電機驅動芯片初始化，設置細分方式；

S1-2、設定死循環，實時檢測按鍵狀態；

S1-3、調用誤差調整模塊，將傾動裝置定位在初始位置；

S1-4、調用按鍵功能模塊，分別進行各個功能模塊操作；

S1-5、結束程序。

3.根據權利要求1所述的用于工程車的傾動裝置控制器，其特征在于所述的脈沖產生程序模塊的程序流程是：

S2-1、P01口輸出高電平；

S2-2、延時；

S2-3、P01口輸出低電平；

S2-4、延時；

S2-5、結束程序。

4.根據權利要求1所述的用于工程車的傾動裝置控制器，其特征在于所述的按鍵功能程序模塊的程序流程是：

S3-1、掃描P2口的值；

S3-2、判斷是否為0X3E，若是，則調用閥芯移動模塊，傳遞前進7mm的參數；否則，執行S3-3；

S3-3、判斷是否為0X3D，若是，則調用閥芯復位模塊；否則，執行S3-4；

S3-4、判斷是否為0X3B，若是，則調用閥芯移動模塊，傳遞后退7mm的參數；否則，執行S3-5；

S3-5、判斷是否為0X37，若是，則調用閥芯移動模塊，傳遞后退5mm的參數；否則，則執行S3-6；

S3-6、判斷是否為0X2F，若是，則調用閥芯移動模塊，傳遞后退4mm的參數；否則，則執行S3-7；

S3-7、判斷是否為0X1F，若是，則調用閥芯移動模塊，傳遞后退3.5mm的參數；否則，執行S3-8；

S3-8、結束程序。

5.根據權利要求1所述的用于工程車的傾動裝置控制器，其特征在于所述的閥芯移動程序模塊的程序流程是：

S4-1、判斷標志位a是否為1，若是，則執行S4-2；否則，執行S4-3；

S4-2、控制步進電機轉動，使閥芯移動到前進7mm的位置，然后執行S4-11；

S4-3、判斷標志位a是否為2，若是，則執行S4-4；否則，執行S4-5；

S4-4、控制步進電機轉動，使閥芯移動到后退7mm的位置，然后執行S4-11；

S4-5、判斷標志位a是否為3，若是，則執行S4-6；否則，執行S4-7；

S4-6、控制步進電機轉動，使閥芯移動到后退5mm的位置，然后執行S4-11；

S4-7、判斷標志位a是否為4，若是，則執行S4-8；否則，執行S4-9；

S4-8、控制步進電機轉動，使閥芯移動到后退4mm的位置，然后執行S4-11；

S4-9、判斷標志位a是否為5，若是，則執行S4-10；否則，執行S4-11；

S4-10、控制步進電機轉動，使閥芯移動到后退3.5mm的位置，然后執行S4-11；

S4-11、結束程序。