混凝土泵車末端軟管運動趨勢檢測系統的設計

余金華，陳新元

（武漢科技大學 機械自動化學院，武漢 430000）

混凝土泵車末端軟管運動趨勢檢測系統的設計

余金華，陳新元

（武漢科技大學 機械自動化學院，武漢 430000）

針對混凝土泵車末端軟管的運動趨勢，提出用三軸重力加速度傳感器進行檢測的方法，確定檢測系統的組成及功能。經過電子元器件的選型、電路的設計和程序的編寫，完成了測試系統的硬件設計和軟件設計，使運動趨勢檢測系統得到實現。通過靜態條件下的功能測試，運動趨勢檢測系統能夠完成對末端軟管運動趨勢檢測，并在顯示設備上進行顯示。

混凝土泵車；運動趨勢檢測；相對方位角

0 引言

混凝土泵車臂架系統的控制是通過遙控器分別控制單節臂來調整末端軟管出料口的位置，這種控制單節臂的方式需要多步操作才能實現，操作方式比較復雜，對操作工人的業務能力要求很高，臂架動作緩慢。實現混凝土泵車臂架系統控制智能化，可以避免現有控制方式的諸多弊端，實現快速準確澆注。

臂架系統控制智能化的一種方式是在混凝土泵車各節臂和末端軟管上安裝傳感器，這些傳感器將測量數據送到中央處理器，當人工拖拽布料軟管時，中央處理器根據末端軟管的運動趨勢及臂架系統的當前狀態計算出各節臂及回轉臺的運動狀態，并將參數反饋給各執行元件執行，這樣就能實現混凝土泵車臂架系統末端隨動功能，末端隨動控制要依據末端布料軟管的姿態來確定其運動趨勢，因而對混凝土泵車末端軟管運動趨勢進行檢測，是臂架系統末端隨動控制系統的重要環節。

1 運動趨勢檢測原理

軟管在自由狀態下呈現豎直狀態，當人工進行拖拽后軟管會發生一定方位的傾斜，軟管傾斜的方位就是它的運動趨勢。對軟管傾斜狀態的傾斜方位進行相應的量化，并用數學方法進行描述，便是對混凝土泵車末端軟管運動趨勢的測量。

以布料軟管豎直狀態時中心軸線的頂端為坐標原點，建立一個空間直角坐標系O-xyz，將此坐標系命名為相對方位坐標系。相對坐標系的位置隨著混凝土泵車臂架系統運動狀態的改變而發生位置的變化，坐標系的z軸保持豎直狀態。將末端布料軟管簡化成一條線段，軟管豎直狀態如圖1中線段OA，人工拖拽發生傾斜后的狀態如圖1中線線段OB。軟管的運動趨勢如圖1中虛線所示，將虛線投影到xOy平面上如圖1中向量OP，軟管的運動趨勢就是向量OP所指向的方位。

圖1 末端軟管運動趨勢示意圖

對向量OP的方位進行量化，便可用具體的數學參量來描述末端軟管的運動趨勢。令向量OP與x軸正半軸沿逆時針方向夾角為α，如圖1所示，夾角α稱為相對方位角，用數學參量α可對末端軟管運動趨勢進行準確的數學描述，α取值范圍為0°到360°。在對軟管運動趨勢的檢測中，以相對方位角α為目標參量進行測量。在得到相對方位角α的值后，即可作為混凝土泵車臂架系統智能控制計算中一個參量，為智能控制確定方位。

2 運動趨勢檢測方法

建立一個測量軸，當測量軸產生傾斜時，重力加速度會在測量軸上產生一個重力加速度分量，應用加速度傳感器可以對測量軸上的重力加速度分量進行測量。

用上述測量重力加速度分量的方法進行混凝土泵車末端軟管運運動趨勢檢測，可選用三軸重力加速度傳感器，在混凝土泵車末端軟管上構建三軸空間測量坐標系如圖2所示，三個測量軸分別對應測量坐標系的x、y、z軸。當末端軟管處于自然豎直狀態時，測量坐標系與相對方位坐標系中的x、y、z軸平行，但正半軸方向相反。三軸重力加速度傳感器的三個軸分別對應測量坐標系的x、y、z軸。gx、gy、gz分別為重力加速度g在x、y、z軸上的分量。

圖2 測重力加速度分量求相對方位角原理圖

調整重力加速度傳感器的z軸與布料軟管的中心軸線平行，那么重力加速度傳感器與布料軟管在測量位置處將有相同的姿態。當布料軟管姿態發生改變時，測量軸上重力加速度分量就會發生變化，重力加速度傳感器測得重力加速度分量值后便可計算相對方位角α。根據gx和gy計算出*α，如式（1）。

由式（1）計算出來的相對方位角*α的范圍為-90°到90°，根據軟管運動趨勢檢測原理，相對方位角α取值范圍為0°到360°。當相對方位角超出*α的范圍時，就需要根據gx和gy的正負對α的象限進行判斷，并由此將式（1）計算出的相對方位角*α轉換為0°到360°范圍內的值，如式（2）。

因此，只要測得重力加速度在測量坐標系中的x軸分量和y軸分量，便可計算得出相對方位角α的準確值。

3 檢測系統方案設計

根據測量重力加速度分量的方法對軟管運動趨勢進行檢測，設計一套運動趨勢檢測系統。運動趨勢檢測系統的方案設計框圖如圖3所示。

圖3 無線運動趨勢檢測系統設計框圖

在運動趨勢檢測系統中，傳感器負責測量重力加速度分量，單片機是檢測系統的中央處理器，系統的控制指令都是由單片機發出的，是檢測系統的核心部分。數據采集端的單片機系統要接收傳感器的輸出信號并對接收到的信號進行數據處理，包括A/D轉換、相對方位角的計算等，并將處理好的信息發送到無線傳輸模塊，控制無線傳輸模塊進行數據的發送。數據監測端的單片機系統要控制無線傳輸模塊對數據進行接收處理，并控制顯示模塊對運動趨勢信息進行顯示，同時將運動趨勢檢測信息傳送到計算機。無線傳輸模塊完成信號的調制和解調。計算機可對運動趨勢信息進行曲線繪制，并對信號進行分析。

4 系統硬件選定及軟件設計

在測試系統中，采用STC89C52RC單片機系統與計算機通訊，從計算機下載程序到單片機，單片機與計算機之間采用USB數據線進行數據的傳輸。MMA7361三軸重力加速度傳感器模塊采集到的數據以模擬量為輸出，PCF8591芯片將傳感器模塊輸出的模擬量轉換成數字量，并由單片機控制進行數據的傳輸。液晶顯示模塊12864ZW與STC89C52RC單片機之間采用串行方式進行數據的讀/寫操作，根據需要編寫出相應的顯示內容。

本文應用MATLAB軟件進行界面的設計和程序的編寫，MATLAB軟件有自帶的GUI設計工具GUIDE，并且MATLAB軟件的繪圖功能很完善，能夠很好的完成界面設計和程序編寫。

用c語言程序分別設計A/D轉換程序模塊、無線通訊程序模塊、串口通訊程序模塊、LCD顯示程序模塊、數據采集端的程序、數據監測端的程序和計算機監測程序。

5 設計成果

根據選定的硬件設計實物圖如圖4所示，將MMA7361三軸加速度傳感器模塊水平放置后向各個方向傾斜以模擬混凝土泵車末端軟管的運動時，運動趨勢檢測系統能夠測量得到末端軟管運動的相對方位角，并能將實時方位角顯示出來。傳感器靜態時測得的方位角LCD顯示及計算機動態圖形繪制如圖5和圖6所示。

圖4 混凝土泵車末端軟管運動趨勢檢測系統實物圖

6 結束語

圖5 運動趨勢在顯示器上顯示

圖6 運動趨勢檢測計算機監控界面

本文以混凝土泵車末端軟管運動趨勢為研究對象，對軟管運動趨勢檢測原理進行了總結，并且根據測量原理提出可用于軟管運動趨勢檢測的方法，運用單片機及相關模塊編程實現了信號的采集、分析處理和在電腦和單片機顯示模塊上的實時顯示。對軟管運動趨勢檢測系統進行了設計實現。

[1] 劉白雁,蘇義腦,陳新元,等.自動垂直鉆井中井斜動態測量理論與實驗研究[J].石油學報,2006,27(4).

[2] 陸剛.論混凝土泵車發展新主張[J].混凝土世界,2011(3)：28-32.

[3] 張艷偉,孫國正,石來德.混凝土泵車支腿反力計算及基于 ANSYS 的支腿結構分析[J].中國工程機械學報,2004(3)：253-258.

[4] 張鑫,孫新香.基于 MMA7260QT 三軸加速度傳感器的跌倒探測儀的研制[J].世界電子元器件,2008(1)：89-94.

Design of the movement trend detection system for the end of the concrete pump truck hose

Y U Jin-hua, CHEN Xin-yuan

TU646

A

1009-0134(2014)05(下)-0143-03

10.3969/j.issn.1009-0134.2014.05(下).41

2014-02-27

余金華（1986 -），男，湖北宜昌人，碩士研究生，主要從事液壓傳動與控制方面的研究工作。