TW498050B - Imbalance monitor device for tower-type crane - Google Patents

Imbalance monitor device for tower-type crane Download PDF

Info

Publication number
TW498050B
TW498050B TW089128356A TW89128356A TW498050B TW 498050 B TW498050 B TW 498050B TW 089128356 A TW089128356 A TW 089128356A TW 89128356 A TW89128356 A TW 89128356A TW 498050 B TW498050 B TW 498050B
Authority
TW
Taiwan
Prior art keywords
motor
control
hanging object
rotation
crane
Prior art date
Application number
TW089128356A
Other languages
Chinese (zh)
Inventor
Ji-Fu Dai
Chung-Yang Gau
Yu-Lin Shen
Jiun-Cheng Chiou
Original Assignee
Inst Of Occupational Safety & Health Council Of Labor Affairs
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Inst Of Occupational Safety & Health Council Of Labor Affairs filed Critical Inst Of Occupational Safety & Health Council Of Labor Affairs
Priority to TW089128356A priority Critical patent/TW498050B/en
Application granted granted Critical
Publication of TW498050B publication Critical patent/TW498050B/en

Links

Landscapes

  • Control And Safety Of Cranes (AREA)

Abstract

An imbalance monitor device for a tower-type crane comprises: a rotary control structure including a motor, a driving component, an upper connection component, and a lower connection component, in which the upper connection component is used to connect to the hook of a hoist, and the lower connection component is used to connect to a hoisted object, the operation of the motor driving, by means of action-reaction, the driving component which is connected to the lower connection device; a tilt control structure including at least a motor, a driving component, and a lower connection component, in which the motor drives the driving component to generate a spatial change, the lower connection component is connected to the driving component, the other end of which is connected to the hoisted object, and the motor and the motor of the rotary control structure forming a direct combination body; a radio control component for activating the motor of the rotary control structure by radio to achieve the objective of rotating the hoisted object, and/or controlling the motor of the tilt structure for tilting the hoisted object.

Description

498050 A7 B7___ 五、發明説明f ) 發明內容 本發明係有關一種塔式起重機用吊掛不平衡監控裝置 及監控方法,尤指一種利用輸入波形開迴路控制法則的塔 式起重機用吊掛不平衡監控裝置及監控方法。 經濟部智慧財產局員工消費合作社印製 塔式起重機目前被廣泛的使用在大樓的營建工地或土 木工程,負責運送鋼骨及預鑄水泥塊等大型貨件的工作。 由於塔式起重體積機非常龐大,起吊的重物往往在數公噸 以上,若是一不小心發生意外,所造成的傷亡及損失十分 嚴重;因此勞工安全衛生法中將起重機列爲危險性機械, 必須依法經檢查合格後才得使用,而起重機的操作員,也 必須接受特殊作業安全衛生教育訓練的測試通過才能操作 起重機。但是因起重機操作員的疏忽或操作不當而造成的 傷亡確時有耳聞,在造成起重機意外的主要原因之一,就 是操作員不當的提高起重機的運動速度,使得吊掛物劇烈 的搖晃,這雖然節省了運送貨件的時間,卻也大大的提高 了危險性。另外當吊掛物到達定位之後,並不能馬上卸下, 並須等到吊掛物停止晃動,在由現場工作人員調整到所需 要的位置,才能卸下,。這些工作,都必須操作的緩慢而且 穩定,若是加快了工作的速度,便增加了危險性,所以在 生產力和安全性上往往很難取得平衡。 以往有關控制姿態的機構,最廣爲爲人知的,就是 * NIST SPIDER(Stev/art Platform Instrumented Drive Environmental Robot)[12],而SPIDER的架構是利用六根伸 縮臂來支撐兩個平面,靠著六根伸縮臂的交互作用,使得 4 498050 A7 __B7 五、發明説明f ) 支撐的平面隨之做X,y,z的移動和各種的轉動。由於機 構複雜且製作成本太高,所以並未被普遍應用。 而我們要設計的機構是針對控制吊掛物姿態來設計 的,目前的現場工地都是靠人力去調整吊掛物的角度,所 以我們要設計的機構要有旋轉360度的功能;另外現場施 工時有時需要將吊掛物傾斜某一個角度,所以我們的機構 也要能傾斜吊掛物的姿態;因此,适兩項需求就是我們設 計機構的重點。 在設計上此控制機構共可分成兩個部份,第一部份我 們要讓吊掛物做360度的正轉和反轉,所以我們的構想是 由鋼索下的掛勾直接鉤住我們機構的支撐軸心,支撐軸上 可分爲兩部分,此兩部分可以產生相反方向的旋轉,進而 帶動吊掛物的旋轉;第二部份則是利用卡盤(SPIDER)的伸 縮臂槪念,在機構兩邊各裝置一支伸縮臂,而伸縮臂下方 鉤住吊掛物,借由兩邊驅動機構不同方向的收放,使吊掛 物受到牽引的作用產生角度的傾斜。 經濟部智慧財產局員工消費合作社印製 在控制方面,我們想要採取遠端控制的方式,這樣可 以讓現場工作人員在安全距離之外操作此一機構,增加使 用上的安全性。 所以我們設計的這項吊掛物姿態控制機構,其功用是 當塔式起重機將吊掛物移動至所需的位置之後,經由現場 •工作人員在遠端加以控制,將吊掛物調整至適當的旋轉角 度,以及一定程度的上下傾斜,讓工作人員在搬運大型物 件時,能夠節省許多不必要的工作以及時間,同時也可以 '5 - 本紙張尺度適用中國國家標準( CNS ) A4規格(210X297公楚) ~ 498050 A 7 B7 五、發明説明f ) 減少搬運時候之潛在危險,使得搬運大型物件的時候能夠 更安全迅速。 本發明之一目的,在提供一種塔式起重機用吊掛不平 衡監控裝置。 本發明之另一目的,在提供一種塔式起重機用吊掛不 平衡監控方法。 本發明又一目的,在提供一種利用輸入波形開迴路法 則的塔式起重機用吊掛不平衡監控裝置。 本發明之再一目的,在提供一種利用輸入波形開迴路 法則的塔式起重機用吊掛不平衡監控方法。 圖示之簡單說明 圖1爲塔式起重機之簡化模型圖。 圖2輸入波形控制法則例示圖。 圖3爲晃動模擬結果曲線圖。 圖4爲本發明塔式起重機縮小模型示意圖。 圖5伺服馬達控制方塊圖。 圖6輸入波形命令之速度曲線圖。 圖7實際之馬達速度曲線圖。 圖8切線方向之晃動角度比較圖。 圖9軸向之晃動角度比較圖。 圖10第一種操作方式示意圖。 . 圖11第一種操作方式晃動結果曲線圖。 圖12第二種操作方式示意圖。 圖13第二種操作方式晃動結果曲線圖。 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 先 閱 讀 背 ij 之 注 意 事 項 再498050 A7 B7___ 5. Description of the invention f) Summary of the invention The present invention relates to a suspension imbalance monitoring device and a monitoring method for a tower crane, especially a suspension imbalance monitoring for a tower crane using an input waveform open loop control rule. Device and monitoring method. Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. Tower cranes are currently widely used in building construction sites or civil engineering, and are responsible for transporting large-scale cargo such as steel skeletons and concrete blocks. Due to the huge volume of tower cranes, the lifting weights are often more than several metric tons. If accidents occur accidentally, the casualties and losses will be very serious; therefore, the crane is listed as dangerous machinery in the Labor Safety and Health Law. It can only be used after passing the inspection according to law, and the crane operator must also pass the test of special operation safety and health education and training to operate the crane. However, the casualties caused by the crane operator's negligence or improper operation are often heard. One of the main reasons for accidents of the crane is that the operator improperly increases the speed of the crane, causing the suspended object to shake violently. Not only does it take time to ship the shipment, it also greatly increases the danger. In addition, when the hanging object reaches the positioning, it cannot be removed immediately, and the hanging object must be shaken and adjusted by the on-site staff to the required position before being removed. These tasks must be performed slowly and stably. If the speed of the work is increased, the danger is increased, so it is often difficult to balance productivity and safety. In the past, the most well-known mechanism for controlling attitude was * NIST SPIDER (Stev / art Platform Instrumented Drive Environmental Robot) [12], and the architecture of SPIDER uses six telescopic arms to support two planes, relying on six The interaction of the telescopic arm makes 4 498050 A7 __B7 V. Description of the invention f) The plane supported by it will then perform X, y, z movements and various rotations. Due to the complexity of the mechanism and the high cost of production, it has not been widely used. The mechanism we want to design is designed to control the attitude of the hanging object. At present, the site of the site relies on human power to adjust the angle of the hanging object, so the mechanism we want to design must have the function of rotating 360 degrees; It is necessary to tilt the hanging object at a certain angle, so our organization should also be able to tilt the hanging object's posture; therefore, meeting two needs is the focus of our design organization. In design, this control mechanism can be divided into two parts. In the first part, we need to make the hanging object rotate 360 degrees forward and reverse, so our idea is to directly hook our institution by the hook under the steel cable. Support the shaft center. The support shaft can be divided into two parts. These two parts can rotate in opposite directions to drive the rotation of the hanging object. The second part is to use the telescopic arm of the chuck (SPIDER). A telescopic arm is installed on each side of the device, and the hanging object is hooked under the telescopic arm. The hanging object is tilted by the traction of the driving mechanism on both sides in different directions. Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs In terms of control, we want to adopt remote control, so that field personnel can operate this institution from a safe distance and increase safety in use. Therefore, the attitude control mechanism of this hanging object designed by us is that when the tower crane moves the hanging object to the required position, it is controlled by the site staff at the remote end to adjust the hanging object to an appropriate rotation angle. , And a certain degree of up and down, so that staff can save a lot of unnecessary work and time when handling large objects, but also '5-This paper size applies to Chinese National Standard (CNS) A4 specifications (210X297) ~ 498050 A 7 B7 V. Description of the invention f) Reduce the potential danger during transportation, and make it safer and faster to move large objects. It is an object of the present invention to provide a suspension imbalance monitoring device for a tower crane. Another object of the present invention is to provide a method for monitoring unbalance of a crane for a tower crane. Still another object of the present invention is to provide a suspension imbalance monitoring device for a tower crane using an input waveform open loop rule. It is still another object of the present invention to provide a method for monitoring unbalance of a suspension of a tower crane using an input waveform open loop rule. Brief description of the diagram Figure 1 is a simplified model diagram of a tower crane. FIG. 2 is an illustration of an input waveform control rule. Fig. 3 is a graph showing the results of shaking simulation. FIG. 4 is a schematic diagram of a reduced model of a tower crane according to the present invention. Figure 5 Servo motor control block diagram. Figure 6 Speed curve of input waveform command. Figure 7 actual motor speed curve. Figure 8 is a comparison of the sway angle in the tangential direction. FIG. 9 is a comparison view of the axial swaying angle. FIG. 10 is a schematic diagram of a first operation mode. . Figure 11 The first operation mode shaking result curve. FIG. 12 is a schematic diagram of a second operation mode. FIG. 13 is a graph of shaking results in the second operation mode. This paper size is in accordance with Chinese National Standard (CNS) A4 (210X297 mm). Please read the notes of ij before reading

經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明f ) 圖14爲本發明塔式起重機用吊掛不平衡監控裝置一 較佳具體之機構側視圖。 圖15爲本發明塔式起重機用吊掛不平衡監控裝置一 較佳具體之機構俯視圖。 圖16控制機構簡化模型示意圖。 圖17-(a)〜17-(d)爲A1旋轉動作示意圖。 圖18-(a)〜18-(c)爲A1傾斜動作示意圖。 圖1 9〜2 2爲實驗結果曲線圖。 圖23、25爲電路方塊圖。 圖24、26爲驅動程式流程圖。 圖號說明 110,2 10,3 10 :馬達 120,130,220,230,320,330 ··齒輪 140,240,340:轉子 250,350 :導螺桿 160 , 260 , 360 , 500 :掛 170,270,370 :纜線 經濟部智慧財產局員工消費合作社印製 600 :吊掛物 在實際工地中的塔式起重機共有三個自由度,第一爲 ,伸臂旋轉,第二爲滑車在伸臂上前後移動,第三爲纜繩經 由捲揚設備拉伸而使吊掛物上下運動。我們爲瞭解要其蓮 動特性,必須推導它的數學模型。首先將實際塔式起重機 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 498050 A7 B7 五、發明説明f ) 架構簡化如圖1。 在圖1中,圓柱代表桅桿,伸臂和旋轉台兩者被視爲 一體,而配重在此示意圖裡已經被簡化。另外吊掛物經由 纜繩連接到伸臂的最前端,在此將吊掛物視爲一質點m, 我們所要設計讓吊掛物旋轉與傾斜的機構亦簡化在其中。 在此先考慮伸臂旋轉時吊掛物晃動的情況,在此情況 下A (伸臂)、A (纜繩)的長度固定,而爲了方便數學模 式之推導,當運動速度不大時,我們可以將纜繩視爲剛體, 不考慮纜繩扭轉所產生的影響。 以下介紹各變數的意義: f :爲伸臂向外伸展的方向,向外爲正端並定爲軸向 ;:爲伸臂旋轉時尖端的切線方向,順時針爲正端 爲另一垂直於平面的方向,向上爲正端 ^:爲旋轉台和伸臂旋轉時的角速度 m :爲吊掛物質量 :爲桅桿中心至吊掛纜繩的距離 ^ :爲伸臂至吊掛物的距離 01 :爲吊掛物所產生切線方向晃動角度 經濟部智慧財產局員工消費合作社印製 02 =爲吊掛物所軸向晃動角度 我們以0爲參考座標的原點,將吊掛物的位置 向量表示爲冲) . ^(0 - [L{ -L2 + [L2-smex{t)\].Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. Description of the invention f) Figure 14 is a side view of a preferred specific mechanism of a suspension imbalance monitoring device for a tower crane according to the present invention. Fig. 15 is a plan view of a preferred specific mechanism of a suspension imbalance monitoring device for a tower crane according to the present invention. FIG. 16 is a simplified model of a control mechanism. Figures 17- (a) to 17- (d) are schematic diagrams of A1 rotation action. 18- (a) to 18- (c) are schematic diagrams of A1 tilting action. Figures 19 to 22 show the experimental results. Figures 23 and 25 are circuit block diagrams. Figures 24 and 26 are flowcharts of the driver. Description of drawing numbers 110, 2 10, 3 10: Motors 120, 130, 220, 230, 320, 330 · Gears 140, 240, 340: Rotors 250, 350: Lead screws 160, 260, 360, 500: Hanging 170, 270, 370: Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Cable Economy 600: The tower crane with hanging objects in the actual construction site has three degrees of freedom, the first is the rotation of the outrigger, and the second is the pulley on the outrigger Moving back and forth, the third is that the rope is stretched up and down by the hoisting equipment to move the hanging object up and down. In order to understand its dynamic characteristics, we must derive its mathematical model. First of all, the actual tower crane's paper size applies to the Chinese National Standard (CNS) A4 specification (210X297 mm) 498050 A7 B7 V. Description of the invention f) The structure is simplified as shown in Figure 1. In Figure 1, the cylinder represents the mast, both the outrigger and the turntable are considered as one, and the counterweight has been simplified in this diagram. In addition, the hanging object is connected to the foremost end of the outrigger through a cable. Here, the hanging object is regarded as a mass point m, and the mechanism we want to design to rotate and tilt the hanging object is also simplified in it. First consider the situation where the hanging object shakes when the outrigger rotates. In this case, the length of A (outrigger) and A (cable) is fixed. In order to facilitate the derivation of the mathematical mode, when the movement speed is not large, we can set A cable is considered a rigid body and does not take into account the effects of cable twisting. The meaning of each variable is introduced below: f: the direction in which the outrigger extends outwards, the outward end being the positive end and determined as the axial direction;: the tangent direction of the tip when the outrigger rotates, the positive end clockwise is the other perpendicular The direction of the plane, the positive end is upward ^: the angular velocity when the rotary table and the outrigger rotate m: the mass of the hanging object: the distance from the center of the mast to the hanging rope ^: the distance from the outrigger to the hanging object 01: for hanging The tangential direction shaking angle generated by the hanging object is printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs. 02 = For the axial shaking angle of the hanging object, we use 0 as the origin of the reference coordinate, and represent the hanging position vector as a punch. ^ ( 0-[L {-L2 + [L2-smex (t) \].

[L2 · cos θχ (/) · cos θ2 (/)] · k (1) -8 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 498050 A7 B7 五、發明説明 爲了方便起見,將、&㈠用04來代表。我們從 能量觀點來推導此運動模型,利用拉格蘭治方程式 (Lagrange’s equations ) Λ δλ 5θη δλ[L2 · cos θχ (/) · cos θ2 (/)] · k (1) -8-This paper size applies to Chinese National Standard (CNS) A4 (210X297 mm) 498050 A7 B7 V. Description of the invention See, will, & ㈠ be represented by 04. We derive this motion model from an energy point of view, using Lagrange ’s equations Λ δλ 5θη δλ

Λ 其中η=1,2 可將系統數學模型求出,其中 λ =T-V (2) m 丁表示動能,V表示位能。利用式子(1)可將系統的動 能及位能求出。動能T爲Λ where η = 1, 2 can be obtained from the mathematical model of the system, where λ = T-V (2) m D represents kinetic energy and V represents potential energy. Using equation (1), the kinetic energy and potential energy of the system can be obtained. Kinetic energy T is

r ·γ ( · γ ( . Ϋ /· Vr · γ (· γ (. Ϋ / · V

1^·θ\ + L1-ei-cosei + L1-y-sin0l + γ-L L2 -/-cos^ -sin^2j -2·Ι22 -r^rsin^ + 2·Ι2 ·γ^Ιχ -(9,-cos^ + 參· · 2.乓·广02·sin^ ·cos0 .cos02 — 2. ·〆·& .cosq ·sin/92 位能V爲 V = —m · g · L2. cos$ cos&2 (3) (4) 經濟部智慧財產局員工消費合作社印製 將式子(3)和式子(4)帶入式子(2)並做線性化,可得 到以^和A爲變數且相依的二階聯立常微分方程式如下: 0 ·· + 2 0 -f γ 0 0 θ2 _g_ L2 r~ r 二y 1 l2 厂 A. l2 r .Ί r (5) 式子(5)即爲塔式起重機單軸驅動的數學運動方程式 倘若我們在伸臂旋轉時,同時下達控制纜繩拉伸及滑 9 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 498050 A7 B7 五、發明説明(7 ) 車運行的命令,也就是伸臂旋轉、纜繩上下和滑車前後這 三軸同動,此時的數學運動方程式就需要藉由單軸的數學 模組來重新推導。 在塔式起重機的三軸運動數學方程式中,、乙不再 是定値,而是隨著纜繩的收放和滑車的運動而改變。和式 子(5) —樣的藉由拉格蘭治方程式’可將三軸同動的二階 聯立常微分方程式導出如下: ·# \l2 1 ——γ • γ + 2γί^ Lj Λ 2Lj + 2 U θ' + 1^2 J θ丨 l2 l2 •擊 θ2_ 丁二 .U Ύ -f- V + 2户焱 、 - r·2] β2 L J .1 a. / U, J [L2 l2\ 若是我們將式子(6)中的A、厶令爲〇,此運動方程式 就變爲雙軸運動(旋轉和上下運動)的聯立方程式,若再 4令爲0,方程式即變爲式子(5)的單軸運動聯立方程式。 在解二階聯立常微分方程式的方法中,利用Runge-Kutta的數値分析方法來求解,這樣可得到吊掛物在每個時 間的晃動角度,作爲我們之後控制法則的重要依據。 經濟部智慧財產局員工消費合作社印製 過去硏究起重機的控制方法大致有兩部分:(1)推導起 重機數學模型和計算最佳時間的軌跡,並利用次最佳化 (Sub-optimal)控制來減低吊掛物晃動[1],⑵將輸入波形 (input-shaping)的控制法則應用於旋轉式起重機。從論文 [2][3]中可以發現第二種的控制法則有相當好的結果,且本 實驗室曾將此理論應用在單軸旋轉上[4],也證實輸入波形 -10- 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公楚) 498050 A7 B7 五、發明説明 的可行性;依以我們使用輸入波形的方法,來作爲塔式起 重機三軸同動時’抑制吊掛物到定位後所產生的晃動之控 制法則。同時也可以做滑車運動的控制法則。在此先介紹 此控制法則: 輸入波形的控制法則是藉由加減速的波形,來達到控 制的目的。加減速的波形如圖2所示: 圖2中&爲前段角加速度,^和^分別爲加速時間、 等速時間和減速時間,七爲後段角加速度。此控制方法在 加速時會激發出系統的震盪,但這些震盪在減速的時候被 抵銷,在減速完成後系統的所有震盪完全被抑制了。 在這之中爲了讓系統在運動結束後能量爲零,所以力 必須滿足以下條件: 並且若要抑制所有震盪,則必須在加一條件如下: 在加入以上兩個限制條件後,控制變數由五個減少至 個參數,而此三個參數則藉由最佳化的方法求得。所用 到的成本函數(cost function)如下: J = (r7)+ \ν2θ{ (/7)+ w.e; (/7)+ W40; (tf) 並且滿足式子(6),在此我們將權重、%、^及%都 調整爲1。 至於我們採用輸入波形控制法則的理由是:藉由此控 制法則開迴路(ο p e η 1 ο ο ρ )的特性,以達到在最短的時間 中抑制吊掛物晃動的目的。若不採用輸入波形控制法則, 11 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 先 閱 讀 背 Ϊ 事 項 再 填, 頁 經濟部智慧財產局員工消費合作社印製 (7) 498050 A7 B7 五、發明説明f ) 而採用閉迴路的控制方式,首先就必須要在吊掛物附近安 置感應器來測得晃動的情況,並且要克服安裝感測器與線 路上的困難度,這些都要耗費一筆可觀的經費;另外當吊 掛物運送至定點附近時,必須多花費時間去抑制晃動,這 樣就無法有效的提高工作效率,而且增加了機構控制的複 雜性,所以我們使用輸入波形的開迴路控制法則,來達到 縮短吊掛物運送時間以及節省經費的效果。 在旋轉、捲揚、以及滑車這三軸的控制方法中,我們 將輸入波形運用在旋轉與捲揚這兩軸的控制,至於纜繩上 下運動在我們推導後的數學運動聯立方程式中只有等速運 動,所以並不須另外使用控制法則去控制。 由於單軸的輸入波形控制法則就需要三個參數-加速 度(al)、加速時間(塔式起重機)、等速時間(吊掛不平衡), 在兩軸同時使用輸入波形的控制法則必須要六個參數,另 外加上捲揚的運動速度以及運動時間,總共是八個變數, 三軸運動各自有不同到達的時間,但是這不是我們所期望 的,因此我們再加上一個限制條件,就是讓三軸的能夠同 時到達目的地(總運行時間相同),這樣一來,變數就只剩 下六個-旋轉加速度、旋轉加速時間、旋轉等速時間、滑 車加速度、滑車加速時間、捲揚上升速度,那麼就可以減 少在尋找最佳解時的複雜度。 • 至於最佳解的求法我們將採取基因演算法,在傳統解 決有限制條件非線性最佳化問題的方法大槪有基本法 (Primal Methods)、懲罰和障礙法(Penalty and Barrier 12 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 先 閲 讀 背 之 注 意 事 項 再 填1 ^ · θ \ + L1-ei-cosei + L1-y-sin0l + γ-L L2-/-cos ^ -sin ^ 2j -2 · Ι22 -r ^ rsin ^ + 2 · Ι2 · γ ^ Ιχ-( 9, -cos ^ + ref. · 2. ping · guang02 · sin ^ · cos0 .cos02 — 2. · 〆 & .cosq · sin / 92 bit energy V is V = —m · g · L2. Cos $ cos & 2 (3) (4) The consumer cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs prints the formula (3) and formula (4) into the formula (2) and linearizes it. Variable and dependent second-order simultaneous ordinary differential equations are as follows: 0 ·· + 2 0 -f γ 0 0 θ2 _g_ L2 r ~ r two y 1 l2 Factory A. l2 r .Ί r (5) Equation (5) It is the mathematical equation of motion of the single-axis drive of the tower crane. If we send out the control cable to stretch and slide at the same time when the outrigger rotates, this paper size applies the Chinese National Standard (CNS) A4 specification (210X297 mm) 498050 A7 B7 V. Description of the invention (7) The command of the car running, that is, the three axes of the arm rotation, the up and down of the cable, and the front and back of the pulley, are moved simultaneously. At this time, the mathematical motion equation needs to be re-derived through a single-axis mathematical module. In the three-axis mathematical equation of the tower crane, It is no longer fixed, but changes as the cable is retracted and the movement of the pulley. (5) —The same type of second-order simultaneous ordinary differential equation that can move three axes simultaneously through Lagrange's equation ' Derived as follows: · # \ l2 1 ——γ • γ + 2γί ^ Lj Λ 2Lj + 2 U θ '+ 1 ^ 2 J θ 丨 l2 l2 • Click θ2_ 丁二 .U Ύ -f- V + 2 -r · 2] β2 LJ .1 a. / U, J [L2 l2 \ If we set A and E in equation (6) to 0, this equation of motion becomes a biaxial motion (rotation and up and down motion) ), If 4 is 0 again, the equation becomes the uniaxial motion simultaneous equation of equation (5). In the method of solving the second-order simultaneous ordinary differential equations, Runge-Kutta's mathematical analysis is used. This method can be used to solve the problem, so that the shaking angle of the hanging object at each time can be obtained as an important basis for our subsequent control rules. The employee consumer cooperative of the Intellectual Property Bureau of the Ministry of Economics has printed two methods of controlling cranes in the past: (1 ) Derive the mathematical model of the crane and calculate the trajectory of the best time, and use Sub-optimal control is used to reduce the sloshing of the hanging object [1], and the input-shaping control law is applied to the rotary crane. From the paper [2] [3], it can be found that the second control law has quite good results, and this laboratory has applied this theory to uniaxial rotation [4], which also confirms the input waveform -10- this paper The scale is applicable to the Chinese National Standard (CNS) A4 specification (210X297). 498050 A7 B7 5. The feasibility of the invention; according to our method of using input waveforms, it is used as a tower crane when the three-axis simultaneous movement of the tower crane 'suppresses hanging objects Control rules for shaking after positioning. At the same time, it can also be used to control the movement of the pulley. This control principle is introduced here: The control principle of the input waveform is to achieve the purpose of control by accelerating and decelerating the waveform. The acceleration and deceleration waveforms are shown in Fig. 2: In Fig. 2, & is the front stage angular acceleration, ^ and ^ are acceleration time, constant speed time and deceleration time, respectively, and 7 is the rear stage angular acceleration. This control method will stimulate system oscillations during acceleration, but these oscillations will be offset during deceleration, and all oscillations of the system will be completely suppressed after the deceleration is completed. In order for the system to have zero energy after the movement, the force must meet the following conditions: And if you want to suppress all oscillations, you must add a condition as follows: After adding the above two constraints, the control variable is changed from five Are reduced to parameters, and these three parameters are obtained by optimization. The cost function used is as follows: J = (r7) + \ ν2θ {(/ 7) + we; (/ 7) + W40; (tf) and satisfies the formula (6), here we will weight ,%, ^, And% are all adjusted to 1. As for the reason why we use the input waveform control rule: the characteristics of the open loop (ο p e η 1 ο ο ρ) are used to control the swing of the hanging object in the shortest time. If the input waveform control rule is not adopted, 11 paper sizes are applicable to the Chinese National Standard (CNS) A4 specification (210X297 mm) Please read the back matter before filling in, page Printed by the Consumers ’Cooperative of Intellectual Property Bureau of the Ministry of Economic Affairs (7) 498050 A7 B7 V. Description of the invention f) When adopting the closed-loop control method, first of all, it is necessary to place a sensor near the hanging object to measure the situation of shaking, and to overcome the difficulty of installing the sensor and the line. It costs a considerable amount of money; in addition, when the hanging object is transported near the fixed point, it must take more time to suppress the shaking, so it cannot effectively improve the work efficiency, and it increases the complexity of the mechanism control, so we use the input waveform to open the The loop control rule is used to achieve the effect of shortening the hanging object transportation time and saving money. In the three-axis control method of rotation, hoisting, and pulley, we use the input waveform to control the two axes of rotation and hoisting. As for the up and down movement of the cable, only the constant velocity in the mathematical equations derived from our derivation Motion, so there is no need to use control rules to control. Since the single-axis input waveform control law requires three parameters-acceleration (al), acceleration time (tower crane), constant speed time (hanging imbalance), the control law of using input waveforms on both axes simultaneously requires six. This parameter, plus the speed and time of the hoisting motion, is a total of eight variables, and the three-axis motion has different arrival times, but this is not what we expect, so we add a constraint, that is, let The three axes can reach the destination at the same time (the total running time is the same). In this way, there are only six variables left-rotation acceleration, rotation acceleration time, rotation isokinetic time, pulley acceleration, pulley acceleration time, and hoisting speed. , Then you can reduce the complexity in finding the best solution. • As for the best solution, we will use genetic algorithms. Traditional methods for solving non-linear optimization problems with constraints include Primal Methods, Penalty and Barrier. (This paper is applicable to this paper.) China National Standard (CNS) A4 specification (210X297 mm) Please read the precautions before filling in

ii 經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明Γ )ii Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. Description of Invention Γ)

Methods)、對偶與切平面法(Dual and Cutting plane Methods)、以及拉格蘭治法(Lagrange Methods)等等,但是 這些方法使用了大量的數學,在求解上非常複雜;而我們 使用的基因演算法[5]則是模仿自然界物競天擇論的方 法,其主要特點是它的搜尋方式是隨機且平行的,並應用 遺傳學上的複製、交配及突變等特性,在廣大的個體之中 反覆搜尋最適合生存的子代,而此最適合生存的子代,即 是最佳化問題中的最佳解或近似解。 以下則是簡單的基因遺傳演算法(Simple Genetic Algorithms)之求解步驟: 第一步:訂出初始染色體的人口數(population) 第二步:評斷出在此人口中每個染色體的優劣 第三步:將目前的染色體(親代),利用突變及重組的 方式產生新的染色體(子代) 第四步:刪除人口中的父代染色體,以便產生新子代 染色體的空位 第五步:評斷新子代染色體的優劣然後將他們放入總 人口之中 第六步:若是得到最佳解,則求解結束,並將最佳解 傳出;否則跳到第三步繼續求解。 我們用採用基因演算法來求輸入波形的最佳解之原因 .爲:遺傳基因演算法藉由自然天擇和遺傳的特性,可盡量 避免最佳解落在局部(local)最佳解之中’並且初始點對 於最後最佳解的影響不大,以不同的起始點而言,此法相 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 先 閱 讀 背 面 之 注 意 事 項 再 填Methods), Dual and Cutting plane Methods, and Lagrange Methods, etc., but these methods use a lot of mathematics and are very complicated to solve; and we use genetic algorithms Law [5] is a method that imitates the natural selection of nature. Its main feature is that its search method is random and parallel, and it uses genetic characteristics such as replication, mating, and mutation among a large number of individuals. Repeated search for the most suitable child, and this best child is the best or approximate solution in the optimization problem. The following are the simple genetic genetic algorithms (Steps to solve): Step 1: Determine the population of the initial chromosome (population) Step 2: Determine the advantages and disadvantages of each chromosome in this population Step 3 : Use the current chromosomes (parents) to generate new chromosomes (offspring) by mutation and recombination. Step 4: Delete the parent chromosomes in the population to generate new chromosomal vacancies. Step 5: Evaluate the new The pros and cons of the offspring chromosomes are then put into the total population. Step 6: If the best solution is obtained, the solution ends and the best solution is passed out; otherwise skip to the third step and continue to solve. We use a genetic algorithm to find the best solution for the input waveform. The genetic algorithm uses natural selection and heredity to avoid the best solution from falling into the local best solution. 'And the initial point has little effect on the final optimal solution. For different starting points, the paper size of this method applies the Chinese National Standard (CNS) A4 specification (210X297 mm). Please read the precautions on the back first. fill

經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明f1 ) 較於傳統求解法有更好的全域搜尋能力;還有,基因傳演 算法不需要複雜的數學運算,只需要一合適的評斷函數, 降低了問題的困難度;另外,基因遺傳演算法爲一種實用 且具有強健性(robustness)的一種搜尋方法,並且廣泛的應 用於許多領域來解決極困難的問題[6] [7]。 但是基因遺傳演算法亦有一些缺點,例如:計算量龐 大和搜尋時間長久,內部參數設定不易(交配及突變機率 等),微調能力較差,隨機誤差的產生等等。 本發明硏發的 M.G.As(Modified Genetic Algorithms)[8] 是在G. As中加上了人口菁英政策、混合式基因運算子及自 我調變參數等方法,改善了原來S.G.As的許多缺點,並且 有許多顯著的效果。因此我們將此一演算法稍加修改後應 用在尋找輸入波形的最佳解上。 在此演算法中所用的初始參數如下·· 請 先 閱 讀 背 之 注 項 再 填 ii 經濟部智慧財產局員工消費合作社印製 染色體長度 ·· 12 0 b i t s 人口總數 :300 交配機率 :88% 突變機率 :1.5% 適應函數 :Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. Description of the invention f1) Better global search capability than traditional solutions; In addition, the gene transfer algorithm does not require complex mathematical operations, only a suitable The evaluation function reduces the difficulty of the problem. In addition, the genetic algorithm is a practical and robust search method, and is widely used in many fields to solve extremely difficult problems [6] [7 ]. However, genetic genetic algorithms also have some shortcomings, such as: large calculation volume and long search time, difficult internal parameter setting (mating and mutation probability, etc.), poor fine-tuning ability, and random error generation. The MGAs (Modified Genetic Algorithms) [8] developed in the present invention is a method of adding population elite policies, hybrid genetic operators, and self-tuning parameters to G. As, which improves many of the shortcomings of the original SGAs. And has many significant effects. Therefore, we slightly modified this algorithm to find the best solution for the input waveform. The initial parameters used in this algorithm are as follows. Please read the note below and fill in the length of the printed chromosome of the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. 12 0 bits Total population: 300 Mating probability: 88% mutation probability : 1.5% fitness function:

Fitness 广~ #(/) + 6>22 (/) + #(,)+ 圬(,) • dt + W2 · Position_ err2 其中%爲最佳化問題中成本函數(cost function)的加權 値;W2爲懲罰係數(penalty coefficient)。我們取A爲7,% 14 本紙張尺度適用中國國家標準(CNS ) A4規格(210X 297公釐) 498050 A7 B7 •-- 五、發明説明严) 爲4.9作爲加權的數値。 接著我們就要利用此改良式機因演算法來尋找輸入波 形的最佳解,根據我們在稍後所描素的縮小之塔式起重機 模型的特性,諸如加速度或是加速時間需要有某種程度的 限制等等,這些限制條件會因機構設備不同而有不同的條 件限制,也因爲如此,使得我們的理論能夠針對不同機構 去尋找不同之最佳控制參數,其適用性更加廣泛。我們將 所有目前實驗的限制納入演算法中,再計算出最佳的控制 參數。 一開始假設吊掛物在伸臂之最遠端(離旋轉中心爲2.2 公尺),而且位於伸臂下方1.8公尺,我們目的地的位置希 望吊掛物能旋轉60度、滑車往內運行1公尺(往內運行爲 負向)、以及捲揚部分上拉0.5公尺,接著我們將此需求帶 入上述的演算法中尋找最佳解,然後再以求得之最佳解, 去模擬實際的運作情形,而所得之結果如下: 經濟部智慧財產局員工消費合作社印製 表1 M.G.As求得之最佳解 旋轉加速度(rad/P) 0.1594 旋轉加速時間(s) 2.1211 旋轉等速時間(s) 0.9776 滑車加速度(m/P) -0.1521 滑車加速時間(S) 2.1671 滑車等速時間(s) 0.8856 捲揚速度(m/s) 0.0954 捲揚上升時間(S) 5.2198 總運行時間(s) 5.2198 模擬之旋轉角度(度) 60.0277 模擬之滑車運行長度(m) -1.0062 模擬之捲揚上升高度(m) 0.4979 •15- 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 498050 A7 B7 經濟部智慧財產局員工消費合作社印製 五、發明説明f3 ) 由此M.G.As方法可以求得不錯的解,我們將此最佳解 帶入Matlab模擬軸向與切線方向的晃動情況’其結果如圖 3所示。 由模擬結果可以得知,切線和軸向方向的晃動角度皆 在1度以內,爲可以接受的程度範圍。接下來我們會建立 一儲存最佳解之資料庫’在輸入目目標位置後’便可以快 速得到近似的最佳解;以下’我們要將這些結果應用到實 際的縮小起重機模型’來驗證我們理論的可行性。 縮小之塔式起重機模型的衍樑總長度爲3.2公尺’總 高度約爲3.4公尺,衍樑主要由I型鋼構成’而滑車於I 型鋼上前後運行,至於捲揚機構與滑車在設計上縮爲一 體,這樣的做法是參考實際之小型塔式起重機而設計的’ 至於配重部分由於,襻費上的問題,我們採用數塊預鑄的鐵 塊來平衡,可以視吊掛物的重量來增減,以平衡整體的力 量,目前配置了約300公斤的配重。在三軸驅動馬達部分’ 我們採用相同的交流伺服馬達,在配與不同的減速比而有 不同的驅動力與驅動速度,此一馬達的特性如下·· 表2 交流伺服馬達規格表 三相220V交流伺服馬達規格表Fitness Wide ~ # (/) + 6 > 22 (/) + # (,) + 圬 (,) • dt + W2 · Position_ err2 where% is the weight 値 of the cost function in the optimization problem; W2 Is the penalty coefficient. We take A as 7,% 14 This paper size applies the Chinese National Standard (CNS) A4 specification (210X 297 mm) 498050 A7 B7 • V. The description of the invention is strict) 4.9 as the weighted number. Next, we need to use this improved mechanistic algorithm to find the best solution for the input waveform. According to the characteristics of the reduced tower crane model we will describe later, such as acceleration or acceleration time, some degree is required. Limitations, etc. These restrictions will have different conditions due to different institutional equipment. Because of this, our theory can find different optimal control parameters for different institutions, and its applicability is more extensive. We incorporate all current experimental constraints into the algorithm and calculate the optimal control parameters. At first, suppose that the hanging object is at the farthest end of the outrigger (2.2 meters from the center of rotation), and it is 1.8 meters below the outrigger. Our destination is that the hanging object can rotate 60 degrees and the pulley can run inward for 1 meter. Ruler (inward running is negative), and the hoisting part is pulled up by 0.5 meters, then we bring this demand into the above algorithm to find the best solution, and then use the obtained best solution to simulate the actual And the results obtained are as follows: Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs, Table 1. The optimal solution rotation acceleration (rad / P) obtained by MGAs 0.1594 rotation acceleration time (s) 2.1211 rotation constant speed time ( s) 0.9776 Pulley acceleration (m / P) -0.1521 Pulley acceleration time (S) 2.1671 Pulley constant speed time (s) 0.8856 Hoisting speed (m / s) 0.0954 Hoisting rise time (S) 5.2198 Total running time (s) 5.2198 Simulated rotation angle (degrees) 60.0277 Simulated running length of the pulley (m) -1.0062 Simulated hoisting rise height (m) 0.4979 • 15- This paper size applies the Chinese National Standard (CNS) A4 specification (210X297 mm) 498050 A7 B7 Ministry of Economy Printed by the Intellectual Property Cooperative Consumer Cooperative Fifth, Invention Description f3) The MGAs method can obtain a good solution. We bring this best solution into Matlab to simulate the axial and tangential sloshing. The results are shown in Figure 3. As shown. It can be known from the simulation results that the sway angles in the tangential and axial directions are within 1 degree, which is an acceptable range. Next, we will build a database that stores the best solution 'after entering the target location', we can quickly get the approximate best solution; the following 'we will apply these results to the actual reduction crane model' to verify our theory Feasibility. The total length of the beam of the reduced tower crane model is 3.2 meters. 'The total height is about 3.4 meters. The beam is mainly composed of I-section steel.' As a whole, this approach is designed with reference to actual small tower cranes. As for the counterweight part, due to the problem of cost, we use several iron blocks to balance, which can be increased depending on the weight of the hanging object. To balance the overall strength, it is currently equipped with a weight of about 300 kg. In the three-axis drive motor section, we use the same AC servo motor, which has different driving forces and driving speeds when equipped with different reduction ratios. The characteristics of this motor are as follows: Table 2 AC servo motor specifications table Three-phase 220V AC servo motor specification table

額定輸出 850 W 轉子債性 13.9e-4kg,2 額定轉矩 5.39 N.m 峰値轉矩 13.8 N.m 額定速度 1500 rpm 最大速度 3000 rpm 額疋電流 7.1 A 峰値電流 17 A 在旋轉軸部分,其減速比約爲1:115,所以經過減速機 -16 本紙張尺度適用中國國家標準(CNS ) A4規格(210 X 297公釐)Rated output 850 W Rotor debt 13.9e-4kg, 2 Rated torque 5.39 Nm Peak peak torque 13.8 Nm Rated speed 1500 rpm Maximum speed 3000 rpm Rated current 7.1 A Peak current 17 A In the rotating shaft part, its reduction ratio It is about 1: 115, so through the reducer-16 this paper size applies to the Chinese National Standard (CNS) A4 specification (210 X 297 mm)

498050 A7 B7 五、發明説明(14 ) 之後的轉矩約爲620 N.m,轉速約爲13 rpm ;假設伸臂在 最大荷重時的轉動慣量約爲800 kg. w2,則旋轉之最大角 加速度可爲0.775 rad/P。 在滑車部分的減速比爲1:4,所以經過減速之後的轉矩 約爲 21.56 N.m,轉速約爲 375 rpm ( 39.27 rad/s);滑車在 I 型鋼上的滑輪半徑約爲3公分,所以可以在負重200公斤 的情況下,約有3 m/P的加速度。 在捲揚部分的減速比和滑車相同,所以減速後有相同 的力矩與速度,而捲揚筒半徑爲2公分,以及吊勾滑輪採 用動滑輪,所以捲揚機可以承受約200公斤的重物而不致 滑落。 經由以上大致估算後,各軸運行上的極限速度與加速 度就可以得知,並可以作爲上一節最佳解的變數輸入限 制,以後在實際應用時,便可以依照此方式,算出各軌運 行的最大規格,作爲尋找變數之最佳解的限制式,使得理 論上找出之最佳解可以應用在實際的機構上,符合機構的 驅動能力。 在伺服驅動器方面,我們採用和交流伺服馬達相同的 安川公司之產品,讓兩者的相容度爲最高。 在控制器方面,我們選用了 Baldor Optimised Control 公司的EuroSystem之三軸控制卡作爲控制三軸伺服器的 •裝置,並且藉由RS-232與電腦相連;整組馬達控制的模 式如圖5。 爲了要讓伺服馬達能夠夠精準的依照我們的命令動 -17- 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) (請先閲讀背面之注意事項再填寫本頁) 、τ 經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明Γ ) 作,因此我們採用了全閉迴路來控制伺服馬達,如下圖所 示,我們將命令藉由RS-232傳到控制卡,控制卡處理的 編碼器回授信號與控制命令後’便輸出適當的信號到驅動 器上,因此控制卡掌握了實際位置的控制。 在使用全閉迴路來控制馬達之後,我們需要適當的調 整控制器上的參數,根據控制卡方塊圖上需要調整的參 數,我們寫了一個小程式來調整最好的參數,使得其暫態 與穩態誤差最小。接著我們輸入輸入波形的控制命令,來 觀察伺服馬達的動作情況。 由以上兩圖可以看出伺服馬達能依照我們需求的命令 動作,接著在裝設完整套控制系統之後,我們利用Visual Basic寫一套控制之介面程式,並整合了輸入波形的控制 法則,以方便我們操作使用。 我們取一組輸入波形的最佳解來作實驗上的結果分 析,另外在取一組沒有使用輸入波形控制法則的實驗結果 來作對照;我們以讓伸臂旋90度,滑車往內運行1公 尺,捲楊上升0.5公尺爲例,以下的結果爲控制命令與 貫驗結果· 經濟部智慧財產局員工消費合作社印製 一適 I度 尺 張 紙 I本 準 標 家 國498050 A7 B7 V. Description of the invention (14) The torque is about 620 Nm and the rotation speed is about 13 rpm; assuming the moment of inertia of the outrigger at the maximum load is about 800 kg. W2, the maximum angular acceleration of rotation can be 0.775 rad / P. The reduction ratio in the pulley part is 1: 4, so the torque after deceleration is about 21.56 Nm, and the rotation speed is about 375 rpm (39.27 rad / s); the pulley radius of the pulley on the I-beam is about 3 cm, so you can With a load of 200 kg, there is an acceleration of about 3 m / P. The reduction ratio on the hoisting part is the same as that of the pulley, so the torque and speed are the same after deceleration, and the radius of the hoisting drum is 2 cm, and the hanging pulley adopts a movable pulley, so the hoist can bear a weight of about 200 kg without slipping. . After the above approximate estimation, the limiting speed and acceleration of each axis can be known, and it can be used as the variable input limit for the best solution in the previous section. In actual applications, you can calculate the running speed of each orbit according to this method. The maximum specification is used as a constraint to find the optimal solution of the variable, so that the theoretically found optimal solution can be applied to the actual mechanism, which conforms to the driving ability of the mechanism. As for the servo driver, we use Yaskawa's products that are the same as AC servo motors to maximize the compatibility between the two. As for the controller, we have selected Eurosystem's three-axis control card from Baldor Optimised Control as the device to control the three-axis server, and connected to the computer through RS-232; the whole set of motor control mode is shown in Figure 5. In order to make the servo motor move accurately according to our order-17- This paper size applies the Chinese National Standard (CNS) A4 specification (210X297 mm) (Please read the precautions on the back before filling this page) τ Economy Printed by 498050 A7 B7 of the Intellectual Property Office of the Ministry of Intellectual Property of the People ’s Republic of China. 5. Invention Description Γ), so we use a fully closed loop to control the servo motor. As shown in the figure below, we send the command to the control card via RS-232. After the encoder processes the control card's feedback signal and control command, it will output appropriate signals to the driver, so the control card has mastered the control of the actual position. After using a fully closed loop to control the motor, we need to properly adjust the parameters on the controller. According to the parameters that need to be adjusted on the block diagram of the control card, we have written a small program to adjust the best parameters so that their transient and Minimal steady state error. Then we input the control command of the input waveform to observe the operation of the servo motor. From the above two figures, we can see that the servo motor can act according to the commands we need. Then, after installing a complete control system, we use Visual Basic to write a control interface program and integrate the control principles of the input waveform to facilitate We operate using. We take the best solution of a set of input waveforms for analysis of the experimental results, and in addition take a set of experimental results without using the input waveform control rule as a comparison; we rotate the outrigger 90 degrees and the pulley runs inward 1 As an example, the volume of the poplar rose by 0.5 meters. The following results are the results of control orders and inspections. • The Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs printed a suitable I-scale paper and a quasi-standard home country.

S N I釐 公 498050 A7 B7 五、發明説明 表3使用輸入波形之控制命令 旋轉加速時間(s) 5.289 旋轉等速時間(s) 1.767 旋轉加速度(rad/2 0.04227 滑車加速時間(s) 2.455 滑車等速時間(s) 7.435 滑車加速度(m// -0.04117 捲揚上升時間(s) 12.345 捲揚速度(m/s) 0.04041 表 沒有使用輸入波形之控制命令 旋轉加速時間(s) 4.127 旋轉等速時間(s) 2.222 旋轉加速度 (rad/夕) 0.05996 請 先 閲 讀 背 之 注 意 事 項 再 填 滑車加速時間(s) 1.443 滑車等速時間(S) 7.590 滑車加速度 -0.07429SNI centrifugal 498050 A7 B7 V. Description of the invention Table 3 Using the input waveform control commands Rotational acceleration time (s) 5.289 Rotational constant speed time (s) 1.767 Rotational acceleration (rad / 2 0.04227 Block acceleration time (s) 2.455 Block constant speed Time (s) 7.435 Pulley acceleration (m // -0.04117 Hoisting rise time (s) 12.345 Hoisting speed (m / s) 0.04041 The table does not use the input waveform control command. Rotation acceleration time (s) 4.127 Rotation constant speed time ( s) 2.222 Rotational acceleration (rad / night) 0.05996 Please read the precautions in the back before filling the acceleration time of the pulley (s) 1.443 Constant time of the pulley (S) 7.590 Acceleration of the pulley -0.07429

Pi 捲揚上升時間(s) 10.476 捲揚速度(m/s) 0.04773 接著將以上的控制命令作實際的實驗操作,其結果如 圖8所示。 實線爲使用最佳輸入波形控制命令的結果,虛線爲任 意輸入的控制命令,由實驗結果可以看出經過最佳Input-Shaping 控制命令的晃 動比任 意輸入 的控制 的還小 ,而且 在動作停止後的晃動約在0.2度之內,因此可以證實輸入 波形控制法則遠比一般沒有使用輸入波形的效果還佳,也 因此驗證了輸入波形的理論。 驗證了輸入波形的可行性之後,爲了配合起重機操作 員使用搖桿控制吊掛物的運送方式,我們硏發出兩種結合 輸入波形與搖桿即時控制的操作方式。 • 第一種配合輸入波形的應用方式:首先我們將搖桿的 操作方式改成爲兩段式,當操作員壓下搖桿時,起重機就 開始運作,而當操作員放開搖桿時,就估算出操作員壓下 19 - 本紙張尺度適用中國國家標準(CNS ) Α4規格(210X297公釐) Μ 經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明ί7 ) 搖桿的時刻;根據壓下搖桿的加速時間,就立即算出輸入 波形所需的等速時間與減速時間,接下來行程就由電腦接 管控制,其示意圖如圖10所示。 就此方式而言,操作員控制的是輸入波形的加速時 間,而等速時間與減速時簡是由電腦所控制的,所以我們 在加速時間項以一秒爲間隔建立一個最佳的參數表,作爲 即時的參數對應表。以單軸爲例,當起重機操作員壓下搖 桿到放開的時間若是超過5.7秒而未達6.7秒時,我們立即 對應到6.7秒的參數,其參數如下表: 表5 加速時間6.7秒的輸入波形參數 旋轉加速時間(S) 6.700 旋轉等速時間(S) 1.002 旋轉加速度(Deg〆) 1.492 總所旋轉角度(Deg) 76.992 總行程時間(S) 14.402 根據我們實驗的結果,其晃動情況如下圖所示,實線 爲切向晃動,虛線爲軸向晃動,由圖中可看出當吊掛物到 達定位後之晃動在0.5度之內。 經濟部智慧財產局員工消費合作社印製 我們利用此種控制方式在較長距離的運行,當停止運 行後若跟操作員預計的位置有些許的差距,我們利用手動 微調的部分讓操作員將吊掛物調整到實際所需的位置,在 這部分的過程中就不使用輸入波形的控制,完全由操作完 來操作。 此種方式在操作上有一個缺點存在,就是當放開搖桿 •後,所有的動作皆由電腦控制,在這段電腦控制的時間內’ 操作員無法做除了緊急停止之外的任何操作;因此,我們 針對這點作了另一項方式的改進。 -2 0 - 本紙張尺度適用中國國家標準(CNS)A4規格(210X297公釐) 498050 A7 B7 五、發明説明(8 第二種配合輸入波形的應用方式:我們將長時間無法 操作的時間縮短,就一段長距離的運送過程而言,我們將 其劃分爲幾段輸入波形的控制,若是搖桿放開的時間在第 一部份輸入波形的運行過程中,就將第一部份的動作完 成,若是行走完第一段運行而在第二部分的時間內放開搖 桿,就在完第二部分的動作完成時停止,這種方式的好處 是,每部分的運行時間較短,不受操作員控制的時間也減 小許多;因爲我們希望將輸入波形的理論配合在較長距離 的運輸,所以我們在分段的部份就採取逐漸縮短距離的策 略,這樣能夠讓操作員在放開搖桿時候的位置與動作停止 時的位置更接近,其示意圖如下: 以單軸爲例,我們只執行三段行程,來觀察其晃動情 況。以下爲其輸入命令與晃動結果: 請 先 閱 讀 背 ίι 之 注 意 事 項 再Pi hoisting rise time (s) 10.476 Hoisting speed (m / s) 0.04773 Then the above control commands are used for actual experimental operation. The results are shown in Figure 8. The solid line is the result of using the best input waveform control command, and the dashed line is the control command of arbitrary input. From the experimental results, it can be seen that the best input-shaping control command has less shaking than the control of arbitrary input, and the action stops. The subsequent sloshing is within about 0.2 degrees, so it can be confirmed that the input waveform control law is far better than the general use of no input waveform, and therefore the theory of the input waveform is verified. After verifying the feasibility of the input waveform, in order to cooperate with the crane operator using the joystick to control the transportation of the hanging objects, we have issued two operation modes combining the input waveform and the joystick real-time control. • The first application method to match the input waveform: First, we changed the operation mode of the joystick to two-stage. When the operator depresses the joystick, the crane starts to operate, and when the operator releases the joystick, It is estimated that the operator presses down 19-This paper size applies to the Chinese National Standard (CNS) A4 specification (210X297 mm) Μ Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. The moment of the invention; 7) The joystick; According to the acceleration time when the joystick is depressed, the constant speed time and deceleration time required for the input waveform are immediately calculated. The next stroke is controlled by the computer. The schematic diagram is shown in FIG. 10. In this way, the operator controls the acceleration time of the input waveform, and the constant speed time and the deceleration time are controlled by the computer, so we establish an optimal parameter table at one-second intervals in the acceleration time term. As an immediate parameter correspondence table. Taking a single axis as an example, when the crane operator depresses the joystick until the release time exceeds 5.7 seconds but does not reach 6.7 seconds, we immediately correspond to the parameters of 6.7 seconds. The parameters are as follows: Table 5 Acceleration time 6.7 seconds Input waveform parameters: Rotational acceleration time (S) 6.700 Rotational constant speed time (S) 1.002 Rotational acceleration (Deg〆) 1.492 Headstock rotation angle (Deg) 76.992 Total travel time (S) 14.402 According to the results of our experiments, its shaking situation As shown in the figure below, the solid line is tangential shaking and the dashed line is axial shaking. It can be seen from the figure that when the hanging object reaches the positioning, the shaking is within 0.5 degrees. Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. We use this control method to run over a long distance. When the operation is stopped, if there is a slight gap with the expected position of the operator, we use the manual fine-tuning part to let the operator hang. The hanging object is adjusted to the actual required position. In this part of the process, the input waveform control is not used, and it is completely operated by the operation. This method has a disadvantage in operation. When the joystick is released, all movements are controlled by the computer. During this period of computer control, the operator cannot perform any operation except emergency stop; Therefore, we have made another improvement on this point. -2 0-This paper size is in accordance with Chinese National Standard (CNS) A4 specification (210X297 mm) 498050 A7 B7 V. Description of the invention (8 The second application method that matches the input waveform: we shorten the time that cannot be operated for a long time, In terms of a long-distance transportation process, we divide it into several input waveform control. If the joystick is released for a period of time during the input waveform operation of the first part, the actions of the first part are completed. If you walk the first section and release the rocker within the time of the second part, it will stop when the action of the second part is completed. The advantage of this method is that the running time of each part is relatively short, Operator control time is also greatly reduced; because we want to match the theory of input waveforms to long-distance transportation, we adopt a strategy of gradually reducing the distance in the segmented section, so that the operator can let go The position of the joystick is closer to the position when the action stops. The diagram is as follows: Taking a single axis as an example, we only perform three strokes to observe the shaking. The following is Enter the command and shake the results: please first read the note back ίι matters again

經濟部智慧財產局員工消費合作社印製 本紙張尺度適用中國國家標準(CNS〉Α4規格(210Χ297公釐) 498050 A7 B7 五、發明説明Γ 表6第二種操作方式之參數 第一段行程之參數 旋轉加速時間(s) 2.700 旋轉等速時間(s) 2.093旋轉加速度(Deg" 3.355 所旋轉角度(Deg) 43.417 行程時間(s) 7.493 請 先 閱 讀 背 旋轉加速時間(s) 2.700 第二段行程之參數 旋轉等速時間(s) 2.151 旋轉加速度(Deg/M 2.609 所旋轉角度(Deg) 34.172 行程時間(s) 7.551 第三段行程之參數 意 事 項 再 填Printed by the Consumers' Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs The paper size is applicable to Chinese national standards (CNS> A4 specification (210 × 297 mm) 498050 A7 B7 V. Description of the invention Γ Table 6 Parameters of the second operation mode The parameters of the first stage of travel Rotational acceleration time (s) 2.700 Rotational constant speed time (s) 2.093 Rotational acceleration (Deg " 3.355 Rotated angle (Deg) 43.417 Travel time (s) 7.493 Please read the back rotation acceleration time (s) 2.700 2. Parameter Rotation constant speed time (s) 2.151 Rotational acceleration (Deg / M 2.609 Rotated angle (Deg) 34.172 Travel time (s) 7.551 Fill in the parameters of the third stage

旋轉加速時間(s) 2.700 旋轉等速時間(s) 2.096旋轉加速度(Deg〆 1.492 所旋轉角度(Deg) 總旋轉角度(Deg) 19.32 96.909 行程時間(s) 總行程時間(s) 7.496 22.54 帶動組件、上連接 經濟部智慧財產局員工消費合作社印製 由圖可得之,當運行停止後,吊掛物的晃動在0.5度 之內。這種的操作方式減少電腦控制的時間,讓起重機操 作員對操作時間與運行位置有更好的操作感覺,爲較佳的 可行方式。 本發明之塔式起重機用吊掛不平衡監控裝置,其包 括·· 一旋轉控制結構,其含一馬達 元件和下連接元件,其中該上連元件用以和吊車之吊鉤連 接,而下連接元件用以和吊掛物連接,該馬達轉動時’藉 作用力一反作用力機制帶動組件轉動,該組件係和該下連 接裝置連接; 一傾斜控制結構,其至少含一馬達,一帶動組件,和 一下連接元件,其中該馬達轉動時,可帶動該帶動組件’ -22 - 本紙張尺度適用中國國家標準(CNS ) Α4規格(210 X 297公釐) 498050 Μ ___Β7_ 五、發明説明〖〇 ) 使其產生距離變化,該下連接元件係和該帶動組件連接, 另一端則和該吊掛物連接,而該馬達係和該旋轉控制結構 之馬達直接成間接給合成一體; 一無線控制組件’用以利用無線電啓動該旋轉控制結 構之馬達,.以達成使吊掛物旋轉之目的,茇/或控制該傾結 構之馬達,以達到使吊掛物傾斜之目的。 根據我們的構想而設計的吊掛物姿態控制機構,其細 部規格如圖14和圖15。 彳… 經濟部智慧財產局員工消費合作社印製 由此圖14和圖15兩圖可知,吊掛物控制機構可分成 兩邰份,第一部分爲馬達110(mo tori)、旱達;120和辱_ 130 (motor3 )以及導螺桿250,300所構成的部份,在此將它命 名爲外部轉子(outside rotator);而第二部份即是轉子 (rotator)和中心齒輪所構成的部份,此兩個元件是固定 住的,命名爲負載轉子(payload rotator )。另外此控制機 構下有三條鋼索,而吊掛物主要的重量是由中心的鋼索來 支撐,藉由控制機構旋轉中心的主軸,將吊掛物的重量傳 至起重機的吊鉤上;至於另外兩條的鋼索,一方面是將外 部轉子所產生的轉動力矩傳至吊掛物上,使吊掛物可旋 轉,另一方面是將馬達210和馬達310所產生的拉伸力傳 至吊掛物上,使吊掛物可以傾斜。 整個機構的動作可以由下圖的簡化模型來說明,分爲 •旋轉部份與傾斜部份: 一、在吊掛物旋轉部份 馬達110轉動時,經由馬達110的轉子和齒輪120帶 -23 - 本紙張尺度適用巾關家縣(€叫》4規格(21(^^97公釐) ""' 498050 A7 B7 五、發明説明f1 ) ~ — 動齒輪130 (負載轉子)旋轉(見圖16 ),由作用力與反作 用力的原理可知’齒輪120和齒輪1 30的旋轉方向相反, 且外部轉子受力的方向必定和負載轉子相反,所以馬達u 〇 的外殻、齒輪120和控制模組兩側的拉伸徵構受力而轉 動,藉由拉伸機構中導螺桿將外部轉子轉動的力量轉化爲 對稱力矩,然後作用於吊掛物上,使得吊掛物因受力偶而 旋轉。 二、在吊掛物傾斜部份·· 藉由控制機構兩側馬達2 10和馬達3 10 (見圖14 )對 稱反向的動作’使得拉伸機構形成一拉一伸的狀態,然後 經由導螺桿而將上升的力量作用在吊掛物上,使得吊掛物 和地平面之間形成一個仰角,即可達到吊掛物傾斜的要 求。 此機搆的旋轉圖17-(a)至17-(d)和傾斜圖18-⑷至18-(c)情形之示意圖如下所示: A·吊掛物旋轉部份動作示意圖·· 此控制機構的優點有三,分別列舉如下·· 經濟部智慧財產局員工消費合作社印製 第一、本機構可由遠端控制酬載姿態,操作員只需利 用二軸的無線信號發射接收模組,即可在遠端控制吊掛物 的姿態’這樣可防止現場工作人員利用人力扶正酬載姿態 時的危險。 * 第二,爲求機構能模組化,所以利用蓄電池提供所需 之能量,故中心馬達(馬達110)採用直流馬達來驅動,並 利用編碼器做迴授,即可知道目前檄構的狀態並加以控 ~ 24 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X 297公楚) 498050 A7 B7 五、發明説明f2 制,使得控制模組有非常好的穩定度及強健性。 第三,此機構爲一控制模組,它爲獨立電源,且易於 拆裝,只要將此模組鉤上原來起重機的吊勾(hook) 500,即 可開始運作,若是電力耗完時,可馬上將此模組拿下充電, 再把另一個已充好電的模組掛上即可操作。 爲了瞭解控制機構的特性,故先以簡化模型來推導其 數學模式,設齒輪130之中心位置座標爲(〇,〇),其半徑爲 rl,而齒輪120中心位置座標爲(X, y),半徑爲r2 ’二者轉 動角度分別爲Φ和0。 由簡化模型可知,狀態變數$共有四個,分別爲 (0 X 少 Θ),利用 DAE^ifferentialAlgebra Equation) [9] [10][11]可將系統數學模型描寫如下: M q-l· Βτλ = F Φ = 0 (8) 請 先 閲 讀 背 面 ί 事 項 再Rotational acceleration time (s) 2.700 Rotational constant speed time (s) 2.096 Rotational acceleration (Deg〆1.492 Rotation angle (Deg) Total rotation angle (Deg) 19.32 96.909 Travel time (s) Total travel time (s) 7.496 22.54 Drive components The print is available from the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. When the operation is stopped, the shaking of the hanging object is within 0.5 degrees. This operation method reduces the time of computer control and allows the crane operator to The operation time and operating position have better operation feeling, which is a better feasible way. The suspension imbalance monitoring device for the tower crane of the present invention includes a rotation control structure including a motor element and a lower connection. Element, wherein the upper connecting element is used to connect with the hook of the crane, and the lower connecting element is used to connect with the hanging object. When the motor rotates, the component is rotated by the reaction mechanism of the reaction force, and the component is connected to the lower connection. Device connection; a tilt control structure, which contains at least a motor, a driving component, and a lower connecting element, wherein when the motor rotates, the driving group can be driven '-22-This paper size applies the Chinese National Standard (CNS) A4 specification (210 X 297 mm) 498050 Μ ___ Β7_ V. Description of the invention 〖〇) Make it change the distance, the next connecting element is connected to the driving component, The other end is connected to the hanging object, and the motor is directly and indirectly integrated with the motor of the rotation control structure; a wireless control component is used to start the motor of the rotation control structure by radio to achieve the hanging object. For the purpose of rotation, the motor of the tilting structure is controlled, so as to achieve the purpose of tilting the hanging object. The detailed specifications of the hanging object attitude control mechanism designed according to our concept are shown in Figure 14 and Figure 15.彳… Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs From these two figures, it can be seen that the hanging control unit can be divided into two parts, the first part is motor 110 (mo tori), drought; 120 and shame_ 130 (motor3) and lead screw 250,300, which is named here as the external rotator (outside rotator); and the second part is the rotor (rotator) and the sun gear part, these two The component is fixed and named the payload rotator. In addition, there are three steel cables under this control mechanism, and the main weight of the suspended object is supported by the central steel cable. The weight of the suspended object is transmitted to the crane hook by the main axis of the control mechanism's rotation center; as for the other two On the one hand, the steel cable transmits the rotating torque generated by the external rotor to the hanging object to make the hanging object rotatable, and on the other hand, transmits the tensile force generated by the motor 210 and the motor 310 to the hanging object to make the hanging object. Can be tilted. The movement of the entire mechanism can be illustrated by the simplified model in the figure below. It is divided into: • Rotating part and inclined part: 1. When the motor 110 of the hanging part rotates, the rotor and gear 120 of the motor 110 pass through the belt-23- This paper scale is suitable for Guanjia County (called "4 specifications (21 (^^ 97mm)" 498050 A7 B7 V. Description of the invention f1) ~ — moving gear 130 (load rotor) rotation (see figure 16), according to the principle of the acting force and the reaction force, it can be known that the rotation directions of the gear 120 and the gear 130 are opposite, and the direction of the external rotor force must be opposite to the load rotor, so the housing of the motor u, the gear 120 and the control mode The tensile structure on both sides of the group is rotated by force, and the force of the external rotor rotation is converted into a symmetrical moment by the lead screw in the stretching mechanism, and then acts on the hanging object, so that the hanging object rotates due to the force couple. In the tilted part of the hanging object, the motor 2 10 and motor 3 10 (see Figure 14) on both sides of the control mechanism are symmetrically reversed to move the stretching mechanism into a stretched and extended state, and then it will rise through the lead screw. Power On the hanging object, an elevation angle is formed between the hanging object and the ground plane, so that the hanging object can be tilted. The rotation of this mechanism is shown in Figures 17- (a) to 17- (d) and Figures 18-⑷ to 18- (c) The schematic diagram of the situation is as follows: A. Schematic diagram of the rotating part of the hanging object. The advantages of this control mechanism are three. They are listed as follows. Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. The operator can control the payload attitude at the remote end, and the operator only needs to use the two-axis wireless signal transmitting and receiving module to control the attitude of the hanging object at the remote end. This can prevent the on-site staff from using human power to correct the attitude of the payload. Second, in order to modularize the mechanism, the battery is used to provide the required energy. Therefore, the center motor (motor 110) is driven by a DC motor and the encoder is used for feedback, and the current state of the structure can be known and added. Control ~ 24-This paper size applies Chinese National Standard (CNS) A4 specification (210X 297 Gongchu) 498050 A7 B7 V. Description of the invention The f2 system makes the control module have very good stability and robustness. Third, this mechanism is a control module, which is an independent power supply and is easy to disassemble. As long as the module is hooked to the hook 500 of the original crane, it can start to operate. Immediately remove this module and charge it, and then hang another charged module to operate. In order to understand the characteristics of the control mechanism, the simplified model is first used to derive its mathematical model, and the center position of the gear 130 is set. The coordinates are (0, 〇), the radius is rl, and the center position of the gear 120 is (X, y), and the radius is r2. The rotation angles of the two are Φ and 0. According to the simplified model, the state variable $ has four , Respectively (0 X less Θ), using DAE ^ ifferentialAlgebra Equation) [9] [10] [11] The mathematical model of the system can be described as follows: M ql · Βτλ = F Φ = 0 (8) Please read the back first ί matters again

0 0 0 Μ 其中 經濟部智慧財產局員工消費合作社印製 φ 0^00 0 0 m 0 0 0 0 /, • 鲁0 0 0 Μ Among which is printed by the Consumer Cooperative of Intellectual Property Bureau of the Ministry of Economic Affairs φ 0 ^ 00 0 0 m 0 0 0 0 /, • Lu

rx -0 F = |〇 F Β xy-xy + / —(η +r2)2 rxy rxx :_+jr 2x 2y 上式的變數意義爲 5 -r2 0 本紙張尺度適用中國國家標準(CNS ) A4規格(210X 297公釐) 498050 Α7 Β7 經濟部智慧財產局員工消費合作社印製 五、發明説明p ) φ :爲限制條件方程式(constraint equations) B :爲限制條件方程式的Jacobian矩陣(Jacobian matrix ) 乂:爲拉格蘭治乘數(Lagrangian multiplier) F :爲外力 τ :爲馬達110的力矩 A :摩擦力 & :摩擦力 在推導出控制機構的數學模型後,接下來利用模擬軟 體驗證數學模型的正確性,首先我們設定初始參數如下: 表7 DAE模擬程式參數設定表 |ρ—==- 11.— 變數 一.—---- 數値 單位 Λ 0.05 1 meter h 1 0.15 meter /, 1 3.75e-4 Kg · m2 h 一 0.02925 Kg . m2 1 - m 10.66 Kg 一開始我們將阻尼項和力矩設爲〇,模擬的狀態證實 爲沒有阻尼的現象,接著在模擬時加入阻尼項’結果模擬 時亦有阻尼現象,這表示我們的模擬程式與數學模型皆正 確無誤。 再來我們令初始條件爲零,並施以一力矩Τ於齒輪11 0 上,另外亦給定阻尼,所以各狀態如下: -26 - 本紙張尺度適用中國國家標準(CNS ) Α4規格(210X297公釐) (請先閲讀背面之注意事項再頁) -!%» 498050 A7 __B7___ 五、發明説明f ) (外 0) χ(0)〆0) 0(0)) = (0 r]+r2 0 0) ^(0) i(0) y(0) έ(0)|=(0 0 0 〇) Γ = 0.03 ,^ = 〇.9 在此阻尼項$爲摩擦力&、&之摩擦參數係數。 結果如圖19、圖20、圖21和圖22所示: (1) 圖19顯示限制條件誤差會收斂,表示此限制條件 正確。 (2) 圖20顯示齒輪120和齒輪130的旋轉角度,由於 剛開始齒輪120即有力矩,所以兩曲線斜率絕對値變大, 在力矩和阻尼項平衡後,曲線即變爲直線。 (3) 圖2 1顯示狀態X和y隨時間化的情形,由於剛開 始齒輪1即有力矩,兩條正弦曲線週期變小,表示齒輪120 繞齒輪130旋轉的速度加快;在力矩和阻尼項平衡後,正 弦曲線週期固定,即齒輪1 20等速繞齒輪1 30旋轉。 (4) 圖22顯示齒輪120繞著齒輪130旋轉的角度,由 於初始齒輪1 20即有力矩,所以曲線斜率變大;在力矩和 阻尼項平衡後,曲線變爲直線,表示齒輪1 20等速繞齒輪 130旋轉。 經濟部智慧財產局員工消費合作社印製 由圖Μ、圖15和圖18之中,我們可以得知馬達210 和馬達3 1 0的用途是來控制吊掛物的傾斜姿態。在驅動方 式部分,我們採用步進馬達來作爲動力的來源,透過一齒 '輪組帶動導螺桿產生上下的運動。最主要的理由是因爲在 機構的設計上,機構兩側拉動吊掛物所需要的力並不會太 大,因此採用步進馬達已足夠產生我們所需要的力量;相 -2 7 - i紙張尺度適用中國國家標準(ϋ ) Α4規格(210X297公釐) ' 498050 A 7 ____B7 五、發明説明P ) 對於一般的伺服馬達而言,步進馬達不但價格便宜而且容 易控制,不必像伺服馬達需要昂貴且複雜的驅動器來控 制;只要設計一塊簡單的控制電路,就可以讓步進馬達達 到我們所要求的動作。 關於步進馬達的驅動電路,我們使用類似一般市面上 所賣的遙控模型之解碼電路,首先將從遙控器接收到的 PWM ( Pulse Width Modulation)訊號加以解碼成爲一個大 小爲土5V的訊號,將此訊號送至微處理器(895 1),經過程 式處理之後輸出,將此用來作爲控制步進馬達的訊號,再 經由達靈頓電路(Darlington)將電流放大之後,輸出至步 進馬達。 經濟部智慧財產局員工消費合作社印製 在步進馬達的驅動程式方面,由解碼過的遙控器訊號 送至微處理器可分爲三種(即順時針、停止、逆時針);當 順時針或是逆時針的旋轉訊號輸入時,微處理器即會送出 轉動的訊號給馬達,而根據遙控器命令大小的不同,旋轉 的速度也隨之改變。當訊號爲停止時,微處理器及停止送 出訊號,此時步進馬達沒有電流通過,這個設計的目的是 爲了要減少電源的損耗以及減輕驅動電路的負荷。由於機 構齒輪和導螺桿的設計,步進馬達沒有電流通過並不會使 吊掛物有滑動的現象,所以這個設計實際上並不會導致安 全上的顧慮。 • 在讓吊掛物產生傾斜的過程之中,我們命令馬達二以 順時鐘方向轉動,同時馬達三以逆時針方向轉動,此時馬 達二經由齒輪帶動導螺桿向上移動,馬達三則帶動導螺桿 -2 8 - 498050 A7 B7 五、發明説明) 向下移動。由於我們要讓機構中間的掛勾和兩側的掛勾都 能同時接觸到吊掛物,所以維持三點爲一直線是必須的。 若是三點沒有在一直線上,便會發生只有兩點能夠拉的到 吊掛物,而有一個掛勾並沒有拉到吊掛物的情形發生,這 是我們不希望看到發生的情況。爲了避免有這種情形發 生,我們必須控制兩顆馬達的位移量在任何情況下都是一 致,而方向皆爲相反的。(平衡點爲和中間掛勾同高的位置) 所以我們可以維持左右的掛勾和中間的掛勾三點成一直 線。 驅動電路的方塊圖如圖23,驅動程式流程圖如圖24。 由圖14、圖15和圖17之中,我們可以得知馬達一是 此機構旋轉的動力來源。在馬達一的選用方面,我們選取 了 DC直流馬達;一般而言,DC馬達在負載大的情況下, 需要極大的啓動電流和操作電流,而當我們供給馬達足夠 的電流時,馬達的最高速度和加速度都遠超過我們的需 要,在工地操作機構時,太快的轉速容易造成失控與危險, 因此我們只需要讓機構能有一個合理的旋轉速度,便可以 達到實際的需求。因此我們選用附有減速機的直流馬達, 以加強轉動時的力矩,並減少控制馬達時的操作電流,如 此不僅可以大量的減低電路在操作時的負擔與功率消耗。 而且會使經由減速機之驅動軸的最高速度和加速度一起變 •小,在電流停止供應的時候,馬達也因爲減速機而減少負 荷慣量的緣故,能夠快速停止轉動,使機構停止旋轉,因 此在速度方面也正好符合了我們以降低危險作爲前提。至 -29 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210 X 297公釐) (請先閱讀背面之注意事項再填頁) 、v 一口 經濟部智慧財產局員工消費合作社印製 498050 A7 B7___ 五、發明説明f ) 於在實際驅動馬達的電路部分,我們使用四顆電源 BJT(POWER BJT),如同圖八所示,當我們欲使馬達開始轉 動時,我們可以同時啓動一號和四號的BJT ’或是啓動二 號或三號的BJT,如此便可以讓電流通過馬達,使馬達旋 轉。馬達的轉動方向在電流通過一、三號BJT和通過二1 四號BJT時是相反的。還有,爲了整個機構的穩定性’我 們還在機構上裝置了一個可以用來偵測負載轉子位置的編 碼器(encoder),此裝置可以經由解碼電路將位置的數位値 回授給用來工作的895 1,透過此編碼器,我們可以對馬達 做限速的功能,而最高速度的控制是由遙控器搖桿的位移 量來決定。在旋轉的速度上,透過程式的控制,總共可以 調整十六段不同的速度,根據遙控器命令大小的不同,旋 轉的速度也隨之改變。而由於前面所述的,當遙控器送出 停止訊號的時候,加上減速機後的直流馬達阻尼係數非常 的高,根據實際機構的實驗結果,馬達在極速轉動而突然 停止供應電流的情形之下,馬達旋轉的角度不會超過45 度,而且幾乎是立刻停止,因此在此省略了煞車的部分的 設計。 經濟部智慧財產局員工消費合作社印製 驅動電路的方塊圖如圖25,其驅動程式流程圖如圖 26 〇 茲就上述各部分再加說明如下: . 一、機構設計部分 I ·軸承(Bearing ) 在姿態控制機構實際應用時,我們必須考慮到軸承能 -3 0 · 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公董) ' 498050 7 Β 五、發明说明Γ ) 夠承受負荷的能力,並且選用適合的軸承種類。才不# # 生軸承無法負荷掉掛物的重量而崩潰的情形發生。 (請先閱讀背面之注意事項再填寫本頁) 用軸承時,有三個要點必須注意到: 1. 軸承承受徑向負荷的能力。 2. 軸承承受軸向負荷的能力。 3. 軸承承受軸心對位偏差的能力。 以下將幾種不同的軸承類型加以比較(表8): 表8 不同軸承類型和性能表現的比較 軸承種類 徑向負荷能力 軸向負荷能力 軸心對位偏差能力 單列球軸承 好 可 可 單列向心止推球軸承 好 很好 差 自動調心球軸承 好 可 很好 圓筒滾柱軸承 很好 差 可 球面滾柱軸承 很好 好 很好 錐形滾柱軸承 很好 很好 差 在整個機構上,共有兩部分使用到軸承,一部分是在 機構旋轉的部分;另一部分則是位於機構兩側導螺桿的地 經濟部智慧財產局員工消費合作社印製 方。 在旋轉部分,由機構的中心支撐桿與機構本體共使用 了三個軸承,由上而下說明,第一個軸承位於外部轉子與 ^中心支撐桿間,第二個軸承位於負載轉子與中心支撐軸 間,第三個位中心支撐軸下方與掛勾間,這三個軸承都必 須承受相當大的軸向負荷力,尤其以第三個軸承而言,吊 本紙張尺度適用中國國家標準(CNS ) Α4規格(210Χ297公釐) 498050 A7 B7 五、發明説明f 掛物大部分的重量是由中心支撐桿承受,因此掛勾與中心 支撐桿間的軸承就必須承受吊掛物大部分的重量;而第一 個軸承需要承受機構整體的重量以及吊掛物施在中心桿之 外的重量;第二個軸承只需承受轉子的重量,詳細圖形可 參 >照圖14及其說明;所以第一、三個軸承必須承受相當大 的軸向力,以實際的情況而言,可能需要承受數頓至數十 頓的重量,而目前市面上的軸承有能力承受這樣的負荷, 因此這部分在設計時需要評估實際的狀況來選用適當的軸 承,才能符合安全性的要求。 在機構兩側部分,軸承的設計只是讓導螺桿順著螺紋 上下運動,設計的重點並不是用來支撐掉掛物的重量,所 以只需承受吊掛物施在中心支撐軸之外的重量,即使吊掛 物的重量皆由兩側的導螺桿承受,其中一側的軸承只要能 夠負荷吊掛物一半的重量即可。 Π .齒輪 由於齒輪在實際應用上所負荷的力要比目前的實驗模 組大的多,因此在重新設計時應注意齒根是否能夠承受所 需的力矩,所以必須加以計算與適度的調整,才能夠避免 崩牙的情形產生。 m .導螺桿 導螺桿的上下運動是經由斜齒輪內的螺紋溝所牽引, .而當實際應用時,就必須考慮導螺桿的剛性是否能夠承受 吊掛物的重力影響而不彎曲’另外導螺桿的螺紋形狀也需 仔細的加以設計以避免螺紋的損毀’這設計時可以在斜齒 3 2 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 先 閱 讀 背 面 之 注 意 事 項 再rx -0 F = | 〇F Β xy-xy + / — (η + r2) 2 rxy rxx: _ + jr 2x 2y The meaning of the above variables is 5 -r2 0 This paper scale applies Chinese National Standard (CNS) A4 Specifications (210X 297 mm) 498050 Α7 Β7 Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs 5. Description of the invention p) φ: Constraint equations B: Jacobian matrix (Jacobian matrix) 限制: Lagrangian multiplier F: External force τ: Moment of motor 110 A: Friction &: Friction After deriving the mathematical model of the control mechanism, the simulation model is used to verify the mathematical model First, we set the initial parameters as follows: Table 7 DAE simulation program parameter setting table | ρ — ==-11.— Variable one. —---- Number unit 値 0.05 1 meter h 1 0.15 meter /, 1 3.75e-4 Kg · m2 h-0.02925 Kg. M2 1-m 10.66 Kg At the beginning we set the damping term and moment as 0, the simulation state proved to be no damping phenomenon, and then added the damping term in the simulation 'Result Damping also occurs during simulation This means that our simulation programs and mathematical models all are correct. Next, let's set the initial condition to zero and apply a torque T to the gear 11 0. In addition, damping is also given, so each state is as follows: -26-This paper size applies the Chinese National Standard (CNS) Α4 specification (210X297) (%) (Please read the precautions on the back first)-!% »498050 A7 __B7___ V. Description of the invention f) (Outside 0) χ (0) 〆0) 0 (0)) = (0 r) + r2 0 0) ^ (0) i (0) y (0) ((0) | = (0 0 0 〇) Γ = 0.03, ^ = 0.9 Here, the damping term $ is the frictional force &, & friction Parameter coefficient. The results are shown in Figure 19, Figure 20, Figure 21, and Figure 22: (1) Figure 19 shows that the constraint error will converge, indicating that the constraint is correct. (2) Figure 20 shows the rotation angle of the gear 120 and the gear 130. Since the gear 120 has a torque at the beginning, the slope of the two curves becomes larger. After the torque and the damping terms are balanced, the curve becomes a straight line. (3) Figure 21 shows the state of X and y over time. Since gear 1 has torque at the beginning, the period of the two sine curves becomes smaller, indicating that the speed of gear 120 rotating around gear 130 is increased. In terms of torque and damping, After balancing, the sine curve period is fixed, that is, the gear 1 20 rotates around the gear 1 30 at a constant speed. (4) Figure 22 shows the angle at which the gear 120 rotates around the gear 130. Since the initial gear 120 has a moment, the slope of the curve becomes larger; after the torque and the damping terms are balanced, the curve becomes a straight line, indicating that the gear 1 20 is at a constant speed. Rotates around the gear 130. Printed by the Consumer Cooperative of Intellectual Property Bureau of the Ministry of Economic Affairs From Figure M, Figure 15 and Figure 18, we can know that the purpose of motor 210 and motor 3 10 is to control the tilting attitude of the hanging object. In the driving mode part, we use a stepping motor as the source of power, and the lead screw is driven by a toothed wheel set to produce vertical movement. The main reason is that in the design of the mechanism, the force required to pull the hanging objects on both sides of the mechanism is not too large, so the use of stepper motors is enough to generate the force we need; phase-2 7-i paper scale Applicable to Chinese national standard (ϋ) A4 specification (210X297 mm) '498050 A 7 ____B7 V. Description of the invention P) For general servo motors, stepping motors are not only cheap and easy to control, they do not need to be expensive and costly as servo motors. Complex driver to control; as long as a simple control circuit is designed, the stepper motor can achieve the action we require. As for the drive circuit of the stepping motor, we use a decoding circuit similar to the remote control model sold in the market. First, we decode the PWM (Pulse Width Modulation) signal received from the remote control into a signal with a size of 5V. This signal is sent to the microprocessor (895 1), and is output after being processed by the program. This signal is used as a signal to control the stepper motor. The current is amplified by Darlington circuit and output to the stepper motor. In the consumer cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs, the driver program of the stepper motor can be divided into three types by the decoded remote control signal sent to the microprocessor (that is, clockwise, stop, counterclockwise); when clockwise or When the input is a counterclockwise rotation signal, the microprocessor will send a rotation signal to the motor, and according to the size of the remote control command, the rotation speed will change accordingly. When the signal is stopped, the microprocessor stops sending signals, and no current is passed through the stepper motor at this time. The purpose of this design is to reduce the power loss and load of the drive circuit. Due to the design of the gear and the lead screw of the mechanism, the absence of current through the stepping motor does not cause the hanging object to slip, so this design does not actually cause safety concerns. • In the process of tilting the hanging object, we ordered motor two to rotate clockwise and motor three to rotate counterclockwise. At this time, motor two moves the lead screw upwards through the gear, and motor three drives the lead screw- 2 8-498050 A7 B7 V. Description of the invention) Move down. Since we want the hooks in the middle and the hooks on both sides to contact the hanging objects at the same time, it is necessary to keep the three points in a straight line. If three points are not on the line, there will be only two points where the hanging object can be pulled, and there is a case where the hanging hook is not pulled to the hanging object. This is what we do not want to see happen. In order to avoid this situation, we must control the displacement of the two motors to be the same in any case, and the directions are opposite. (The balance point is the same height as the middle hook) So we can keep the left and right hooks and the middle hook at three points in a line. The block diagram of the driver circuit is shown in Figure 23, and the driver program flowchart is shown in Figure 24. From Figures 14, 15 and 17, we can see that the first motor is the source of power for the rotation of this mechanism. In the selection of motor one, we chose DC motors. Generally speaking, DC motors require a large starting current and operating current when the load is large. When we supply sufficient motor current, the maximum speed of the motor The acceleration and acceleration are far beyond our needs. When operating the mechanism on the construction site, too fast speed is likely to cause runaway and danger. Therefore, we only need to let the mechanism have a reasonable rotation speed to meet the actual demand. Therefore, we choose a DC motor with a speed reducer to enhance the torque during rotation and reduce the operating current when controlling the motor. This can not only greatly reduce the load and power consumption of the circuit during operation. In addition, the maximum speed and acceleration of the drive shaft via the reducer are reduced together. When the current is stopped, the motor also reduces the load inertia because of the reducer. It can quickly stop the rotation and stop the mechanism from rotating. Speed also fits our premise of reducing danger. To -29-This paper size applies Chinese National Standard (CNS) A4 specification (210 X 297 mm) (please read the precautions on the back before filling in the page), v. Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7___ 5. Description of the invention f) In the circuit part that actually drives the motor, we use four power BJTs (POWER BJT), as shown in Figure 8. When we want to start the motor, we can start the number one and four at the same time No. BJT 'or start No. 2 or No. 3 BJT, so that the current can be passed through the motor and the motor is rotated. The direction of rotation of the motor is reversed when the current passes through No. 1 and No. 3 BJT and through No. 2 and No. 4 BJT. In addition, for the stability of the entire mechanism, we also installed an encoder on the mechanism that can be used to detect the position of the load rotor. This device can feedback the position digits to the work via a decoding circuit. 895 1. Through this encoder, we can limit the speed of the motor, and the maximum speed control is determined by the amount of displacement of the remote control joystick. Regarding the rotation speed, through program control, a total of sixteen different speeds can be adjusted. Depending on the size of the remote control command, the rotation speed also changes. As mentioned above, when the remote controller sends a stop signal, the damping coefficient of the DC motor after the reducer is very high. According to the experimental results of the actual mechanism, the motor suddenly stops supplying current at the extreme speed. The rotation angle of the motor will not exceed 45 degrees, and it will stop almost immediately, so the design of the brake part is omitted here. The block diagram of the driving circuit printed by the Employees' Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs is shown in Figure 25, and the flow chart of its driver program is shown in Figure 26. The above parts are explained below: 1. Institution design part I · Bearing In the practical application of attitude control mechanism, we must consider the bearing energy-3 · This paper size is applicable to Chinese National Standard (CNS) A4 specification (210X297), 498050 7 Β V. Description of the invention) Capable of bearing load , And select the appropriate bearing type.才 不 # # The situation that the raw bearing fails to load the weight of the hanging object and collapses. (Please read the precautions on the back before filling out this page) When using bearings, there are three important points to note: 1. The bearing's ability to withstand radial loads. 2. The bearing's ability to withstand axial loads. 3. Bearing's ability to withstand misalignment of shaft center. The following compares several different bearing types (Table 8): Table 8 Comparison of different bearing types and performances Bearing types Radial load capacity Axial load capacity Axial center misalignment capacity Single row ball bearings Good Coco Single row centripetal stop Push ball bearings are very good, poor self-aligning ball bearings are good, very good, cylindrical roller bearings are very poor, spherical roller bearings are very good, very good, tapered roller bearings are very good, and very poor. Part of the bearing is used, part is the part that rotates in the mechanism; the other part is the printout of the staff consumer cooperative of the Intellectual Property Bureau of the Ministry of Economics, located on the two sides of the mechanism. In the rotating part, three bearings are used by the center support rod of the mechanism and the body of the mechanism. From top to bottom, the first bearing is located between the outer rotor and the center support rod, and the second bearing is located between the load rotor and the center support. Between the shafts, between the third position below the central support shaft and the hooks, these three bearings must bear a considerable axial load. Especially for the third bearing, the paper size of the hanging paper is applicable to the Chinese national standard (CNS ) A4 specification (210 × 297 mm) 498050 A7 B7 V. Description of the invention f Most of the weight of the hanging object is borne by the center support rod, so the bearing between the hook and the center support rod must bear most of the weight of the hanging object; One bearing needs to bear the overall weight of the mechanism and the weight of the hanging object outside the center rod; the second bearing only needs to bear the weight of the rotor. For detailed graphics, please refer to Figure 14 and its description; Each bearing must bear a considerable axial force. In practical terms, it may need to withstand a weight of several to tens of tons, and currently the bearings on the market are capable of bearing Such a load, so this part needs to evaluate the actual condition to select the appropriate bearing when designing, in order to meet the safety requirements. On both sides of the mechanism, the bearing design only moves the lead screw up and down along the thread. The focus of the design is not to support the weight of the hanging object, so it only needs to bear the weight of the hanging object outside the central support shaft. The weight of the hanging object is borne by the lead screws on both sides, and the bearing on one side only needs to bear half the weight of the hanging object. Π. Gears have a much larger load in actual application than the current experimental module. Therefore, when redesigning, pay attention to whether the tooth root can withstand the required torque, so it must be calculated and adjusted appropriately. In order to avoid the situation of tooth decay. m. The up and down movement of the lead screw is pulled by the thread groove in the helical gear. When it is applied, it must be considered whether the rigidity of the lead screw can withstand the gravity of the hanging object without bending. The shape of the thread also needs to be carefully designed to avoid the damage of the thread. This design can be used on helical teeth 3 2-This paper size applies to China National Standard (CNS) A4 (210X297 mm) Please read the precautions on the back before

經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明) 輪下增加套統,套統內也刻有螺紋溝,因此用來增加導螺 桿與螺紋溝的接觸距離,以分擔螺紋承受的力量,減少螺 紋的磨耗。 IV.機構本體 此機構的本體是一個一體成型且近正方體的盒子,所 以相對來說比較不會產生彎曲形變的問題,但是兩側馬達 則是以螺絲鎖在本體之上,而且其C字形的結構相對來說 較爲脆弱,容易因吊掛物的重量而產生彎曲,因此這一個 地方在機構放大時應該要加以注意是否能承受其拉動吊掛 物時產生的負荷。 V .步進馬達 由於成本和電路控制方便的考量下,我們在實驗的吊 掛物姿態控制機構是採用步進馬達來作爲帶動兩側的導螺 桿之驅動裝置。這樣的設計在目前機構上運作的非常順 利,並沒有發生任何困擾之處。但是在實際的應用上,步 進馬達的特性並沒有辦法達成我們所要的需求,所以我們 必須改採直流伺服馬達來工作。下表將步進馬達和直流伺 服馬達的特性加以比較: 表9 步進馬達和直流伺服馬達的比較 本紙張尺度適用中國國家標準(CNS ) Α4規格(210Χ297公釐) (請先閲讀背面之注意事項再填^:頁) N- 經濟部智慧財產局員工消費合作社印製 步進馬達 直流伺服馬達 功率 低 筒 最高轉速 低 高 最高轉矩 小 大 重量 重 輕 -33- 498050 A7 __B7 五、發明説明f1 ) 由表9可知,步進馬達在實際應用上的最大缺點是功 率較小,而且轉速和轉矩的表現都無法與直流伺服馬達相 比。所以當我們將吊掛物控制機構在應用於實際的工地之 上時’兩側馬達改採直流伺服馬達是必要的,否則步進馬 達極可能因無法支撐吊掛物的力矩而產生滑動或無法旋轉 的情況;也因此在電路設計上也需要作適當的修改。 二、 驅動電路 在設計這個姿態控制機構的驅動電路時,由於成本的 考量,兩側步進馬達和中間的直流馬達的驅動電路都是自 行硏發設計,因此雖然經過不斷的改進,其功能與效能皆 和市面上的馬達驅動器仍有一段差距,若要製造實際應用 的機構時,建議最好採用市面上的直流伺服馬達驅動器, 雖然會導致整個機構的成本上昇不少,不過卻可以在功能 和馬達的特性上的表現有相當大的提升,並減少設計上的 複雜度。 三、 安全設計 經濟部智慧財產局員工消費合作社印製 由於此機構目前僅止於一個實驗性質的裝置,所以有 些部分在實際安全的考量方面並沒有仔細的設計,因此在 這裡將可能會發生的危險和一些基於安全考量芳面的設計 •加以分析與建議。 I ·兩側導螺桿的端點停止裝置 在兩側導螺桿部分,應該在其兩側端點處分別加裝停 -3 4 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 498050 A7 ________B7_ 五、發明説明P ) 止裝置’使的當導螺桿行進至端點時,可以自動停止原方 向上的運動。如此可以避免當操作的人員在操作機構時因 爲不慎導致不必要的碰撞和磨損,也可以防止馬達因爲失 步所造成對電路的衝擊;而目前的實驗模組僅以兩顆螺帽 來作爲停止裝置,在實際應用時可以加裝感測器作爲端點 的偵測,並在機械結構上加裝適當的裝置作爲雙重的保 護。 Π ·驅動電路的警急停止開關 由於姿態控制機構的控制是採用遙控的方式,而且是 以類比的訊號在傳輸,因此雖然採用相當精密的遙控模 組,但是仍然需要預防一些因雜訊干擾導致機構失控而產 生的一些意外。因此我們可以分別在遙控端和機構上各加 裝一個警急停止的開關,當開關關閉時整個電路自動斷 電,這樣即可以當裝置受雜訊干擾而失控時避免意外的發 生;此部份在本實驗機構上並沒有設計,因在實際應用時 必須加入電路的設計之中。 m .調整姿態時的速度限制 經濟部智慧財產局員工消費合作社印製 在調整吊掛物的平面和傾斜的角度的時候,若是速度 過快容易產生附近的工作人員的危險,因此我們有必要在 寫程式控制時加上限制馬達轉速的上限的條件’以便將姿 態調整的速度控制在安全的範圍之內,減少此大型機構一 •些潛在的危險;此速度限制在本實驗機構設計之初便有加 以考慮,因此採用附有減速機之直流馬達,將最大速度降 至一合理的範圍之內,因此未來在實際應用設計時’除了 -35- 本紙張尺度適用中國國家標隼(CNS ) A4規格(210X297公釐〉 498050 A7 _____B7______ 五、發明説明3e ) 可以寫程式控制之外,也可在選購馬達時加以配合’將速 度的危險性降至最低。 本發明尙含一塔式起重機用吊掛不平衡監控方法,其 包括··將吊掛物吊掛在吊掛不平衡上,並以控制機構指揮 該吊掛不平衡,用以調整一該控制機構之樣態’使該吊掛 物之樣態符合需求,其中該控制機構和該吊掛不平衡係以 無線或有線方式交互作用,其特徵在··該控制機構在實質 上中央處具有一旋轉控制結構,用以在必要時,可依控制 機構之指令旋轉,使吊掛物依反方向旋轉;且該控制機構 至少一側具有一傾斜控制結構,用以在必要時,可接受控 制機構之指令調整吊掛物之傾斜度。 上述之旋轉控制結構,傾斜控制結構及無線控制方 式,均如前述。 上述之旋轉控制結構,傾斜控結構及無線控制方式, 均如前述。 上述控制方式,以無線控制爲較佳。 (請先閲讀背面之注意事項再頁) 經濟部智慧財產局員工消費合作社印製 適 度 尺 張 一纸 本 準 標 家 一國 國Printed by the Employees' Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. Description of the invention) A sleeve is added under the wheel, and the groove is also engraved in the sleeve. Therefore, it is used to increase the contact distance between the lead screw and the thread groove to share the thread bearing The power reduces thread wear. IV. Mechanism body The body of this mechanism is a one-piece and near-cuboid box, so there is relatively little problem of bending deformation, but the motors on both sides are locked on the body with screws, and its C-shape The structure is relatively fragile, and it is easy to bend due to the weight of the hanging object. Therefore, when this mechanism is enlarged, attention should be paid to whether it can withstand the load generated by pulling the hanging object. V. Stepping motor Due to the consideration of cost and convenient circuit control, the hanging attitude control mechanism in our experiment uses stepping motor as the driving device to drive the guide screws on both sides. This design works very smoothly in current institutions, without any trouble. However, in practical applications, the characteristics of the stepping motor do not meet our needs, so we must use a DC servo motor instead. The following table compares the characteristics of stepper motors and DC servo motors: Table 9 Comparison of stepper motors and DC servo motors This paper size applies Chinese National Standard (CNS) Α4 specification (210 × 297 mm) (Please read the note on the back first (Fill in the matter again ^: page) N- Printed by the Consumer Property Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs, stepper motor, DC servo motor, low power, high speed, high speed, high torque, small, heavy and light -33-498050 A7 __B7 f1) As can be seen from Table 9, the biggest disadvantages of stepping motors in practical applications are low power, and the performance of speed and torque cannot be compared with DC servo motors. Therefore, when we apply the hanging object control mechanism on the actual construction site, it is necessary to change the DC motors on both sides of the motor, otherwise the stepping motor is likely to slide or fail to rotate due to the inability to support the hanging object's torque. Situation; therefore, appropriate modifications are also needed in circuit design. 2. Drive circuit When designing the drive circuit of this attitude control mechanism, due to cost considerations, the drive circuits of the stepper motors on both sides and the DC motor in the middle are designed by themselves. Therefore, after continuous improvement, its functions and There is still a gap between the performance and the motor drive on the market. If you want to manufacture a practical application, it is recommended to use a DC servo motor drive on the market. Although it will cause the cost of the entire mechanism to increase a lot, it can And the performance of the motor has been considerably improved, and the complexity of the design has been reduced. 3. Safety design Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs. Because this institution is currently limited to an experimental device, some parts have not been carefully designed in terms of actual safety considerations, so it may happen here. Hazard and some design based on safety considerations • Analyze and advise. I · End stop device of the lead screw on both sides In the part of the lead screw on both sides, stop should be installed at the end points of both sides-3 4-This paper size applies to China National Standard (CNS) A4 specification (210X297 mm) ) 498050 A7 ________B7_ 5. Description of the invention P) Stop device 'When the lead screw travels to the end point, it can automatically stop the movement in the original direction. This can avoid unnecessary collision and wear caused by the operator when operating the mechanism, and can also prevent the motor from impacting the circuit due to out of step; the current experimental module uses only two nuts For the stop device, a sensor can be installed as the end point detection in actual application, and a suitable device can be installed on the mechanical structure for double protection. Π · The emergency stop switch of the driving circuit is controlled by the attitude control mechanism by remote control, and is transmitted by analog signals. Therefore, although a fairly precise remote control module is used, it is still necessary to prevent some noise interference. Some accidents caused by the out of control of the organization. Therefore, we can install an emergency stop switch on the remote end and the mechanism. When the switch is closed, the entire circuit is automatically powered off. This can prevent accidents when the device is out of control due to noise interference; this part There is no design on this experimental mechanism, because it must be added to the circuit design in practical application. m. Speed limit when adjusting attitude. Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs. When adjusting the plane and tilt angle of the hanging object, if the speed is too fast, it may cause danger to nearby staff, so we need to write The condition of limiting the upper limit of the motor speed is added to the program control in order to control the speed of the attitude adjustment within a safe range, reducing some potential dangers of this large mechanism; this speed limit is available at the beginning of the design of this experimental mechanism. Taking into consideration, therefore, the DC motor with a reducer is used to reduce the maximum speed to a reasonable range. Therefore, in the future, the actual application design is 'except -35-' This paper standard applies to China National Standard (CNS) A4 specifications (210X297 mm> 498050 A7 _____B7______ V. Description of Invention 3e) In addition to programming control, you can also cooperate with the purchase of motors to minimize the danger of speed. The invention includes a suspension imbalance monitoring method for a tower crane, which comprises: hanging a suspended object on the suspension imbalance, and controlling the suspension imbalance with a control mechanism to adjust a control mechanism. The "state" makes the state of the hanging object meet the requirements, wherein the control mechanism and the hanging imbalance interact in a wireless or wired manner, which is characterized in that the control mechanism has a rotation control at a substantially central position. Structure, when necessary, can rotate according to the instruction of the control mechanism, so that the hanging object rotates in the opposite direction; and at least one side of the control mechanism has a tilt control structure, which can be adjusted by the instruction of the control mechanism when necessary The inclination of the hanging object. The above-mentioned rotation control structure, tilt control structure and wireless control method are as described above. The above-mentioned rotation control structure, tilt control structure and wireless control method are all as described above. The above control method is preferably wireless control. (Please read the notes on the back first, then the page.) Printed by the Consumer Cooperatives of the Intellectual Property Bureau of the Ministry of Economic Affairs.

NS 498050 A7 B7 五、發明説明$ 參考文獻 [1] Ali R. Cloafshani, and J. D. Aplevich/Oomputation of Time-Optimal Trajectories for Tower Cranes,,,IEEE,1 995,pp.l 134·1139 [2] Gordon G. Parker, Ben Petterson, Clark R. Dohrmann,and Rush D. Robinett,’’Vibration Suppression of Fixed-Time Jib Crane Maneuvers”,SPIE,1 995,Vol 2447, pp.131 -140 [3] Gordon G. Parker, Rush D. Robineet, Brain J. Dressen, and Clark R. Dohrmann,’’Operator in-the-loop control of rotary cranes’’,SPIE,1996,Vol 272 1,pp.364-372 [4] 李訓賢,”塔式起重機操作時之晃動抑制與其酬載 姿態之控制”,交通大學碩士論文,民國八十七年六月。 [5] Chin-Teng Lin and C. S. George Lee, “Neural Fuzzy Systems— A Neuro- Fuzzy Synergism to Intelligent Systems,” Prentice-Hall P T R·, 1996· [6] M· Srinivas, Lalit M· Patnaik,“Genetic Algorithms: A Survey,” p.17〜p.66, v.27, Jun 1994.NS 498050 A7 B7 V. Description of the invention References [1] Ali R. Cloafshani, and JD Aplevich / Oomputation of Time-Optimal Trajectories for Tower Cranes ,,, IEEE, 1 995, pp.l 134 · 1139 [2] Gordon G. Parker, Ben Petterson, Clark R. Dohrmann, and Rush D. Robinett, "Vibration Suppression of Fixed-Time Jib Crane Maneuvers", SPIE, 1 995, Vol 2447, pp.131 -140 [3] Gordon G. Parker, Rush D. Robineet, Brain J. Dressen, and Clark R. Dohrmann, `` Operator in-the-loop control of rotary cranes '', SPIE, 1996, Vol 272 1, pp.364-372 [4] Li Xunxian "" Sloshing suppression during tower crane operation and control of its payload attitude ", Master's Thesis of Jiaotong University, June 87. [5] Chin-Teng Lin and CS George Lee," Neural Fuzzy Systems—A Neuro -Fuzzy Synergism to Intelligent Systems, "Prentice-Hall PTR., 1996. [6] M. Srinivas, Lalit M. Patnaik," Genetic Algorithms: A Survey, "p.17 ~ p.66, v.27, Jun 1994 .

[7] D. E. Goldberg,“Genetic Algorithms in Search, Optimization and Machine Learning’’,Addison-Wesley, Reading,Mass·,1 989.[7] D. E. Goldberg, “Genetic Algorithms in Search, Optimization and Machine Learning’ ’, Addison-Wesley, Reading, Mass ·, 1 989.

[8] 王鎭國,”應用改良式之基因演算法則於化學氣相 沉積製程之最佳化”,交通大學碩士論文,民國八十六年六 月0 7 - 本紙張尺度適用中國國家標準(CNS ) A4規格(210X297公釐) 請 閱 讀 背 面 之 注 意 事 項 再[8] Wang Yiguo, “Optimization of chemical vapor deposition process using improved genetic algorithms”, Master's thesis of Jiaotong University, June 86, Republic of China 7-This paper standard applies to Chinese National Standard (CNS) A4 size (210X297mm) Please read the notes on the back again

經濟部智慧財產局員工消費合作社印製 498050 A7 B7 五、發明説明T ) [9] James Albus, Roger Bostelman, and Nicholas Dagalakis,’’The Nist Robocrane’’,Journal of Robotic System, 1 993 ,pp. 709-724 [1 0]K.C.Park9 C.A.Felippa, J.C. Chiou,^Constraint Treatment Techniques and Parallel Algorithms for Multibody Dynamic Analysis’’,College of Engineering University fo Colorado,1990 [ll]Parviz E· Nikravesh,“Computer-Aided Analysis of Mechanical SystemPrentice-Hall International Editions,1988Printed by the Consumer Cooperative of the Intellectual Property Bureau of the Ministry of Economic Affairs 498050 A7 B7 V. Description of Invention T) [9] James Albus, Roger Bostelman, and Nicholas Dagalakis, "The Nist Robocrane", Journal of Robotic System, 1 993, pp. 709-724 [1 0] KCPark9 CAFelippa, JC Chiou, ^ Constraint Treatment Techniques and Parallel Algorithms for Multibody Dynamic Analysis '', College of Engineering University fo Colorado, 1990 [ll] Parviz E. Nikravesh, "Computer-Aided Analysis of Mechanical System Prentice-Hall International Editions, 1988

James Albus,Roger Bostelman, and Nicholas Dagalakis, “The NIST Robocrane,,,Journal of Robotic Systems,1993 請 先 閱 讀 背 面 I 事 項 再 Ψ 經濟部智慧財產局員工消費合作社印製 本纸張尺度適用中國國家標準(CNS ) A4規格(210X297公釐)James Albus, Roger Bostelman, and Nicholas Dagalakis, "The NIST Robocrane ,,, Journal of Robotic Systems, 1993 Please read the first item on the back before Ψ The Ministry of Economic Affairs Intellectual Property Bureau employee consumer cooperative prints this paper to apply Chinese national standards ( CNS) A4 size (210X297 mm)

Claims (1)

498050 iJU C8 D8 六、申請專利範圍 1 · 一種塔式起重機用吊掛不平衡監控裝置,其包括: 一旋轉控制結構,其含一馬達,一帶動組件、上 連接元件和下連接元件,其中該上連、元件用以和吊車 人 之吊鉤連接,而下連接元件用以和吊掛物連接,該馬 達轉動時,藉作用力一反作用力機制帶動組件轉動, 該組件係和該下連接裝置連接; 一傾斜控制結構,其至少含一馬達,一帶動組件, 和一下連接元件,其中該馬達轉動時,可帶動該帶動 組件,使其產生距離變化,該下連接元件係和該帶動 組件連接,另一端則和該吊掛物連接,而該馬達係和 該旋轉控制結構之馬達直接成間接給合成一體; 一無線控制組件,用以利用無線電啓動該旋轉控 制結構之馬達,以達成使吊掛物旋轉之目的,及/或控 制該傾結構之馬達,以達到使吊掛物傾斜之目的。 2· —種塔式起重機用吊掛不平衡監控方法,其包括: 將吊掛物吊掛在吊掛不平衡上,並以控制機構指 揮該吊掛不平衡,用以調整一該控制機構之樣態,使 該吊掛物之樣態符合需求,其中該控制機構和該吊掛 不平衡係以無線或有線方式交互作用,其特徵在:該 控制機構在實質上中央處具有一旋轉控制結構,用以 • 在必要時,可依控制機構之指令旋轉,使吊掛物依反 方向旋轉;且該控制機構至少一側具有一傾斜控制結 構,用以在必要時,可接受控制機構之指令調整吊掛 -39- 本紙張〈㈣財關家鮮(CNS)A4規格⑵0x297公髮) ' -- -------#--- (請先閱讀背面之注意事項再填寫本頁) I H ϋ n n I ϋ ϋ .1 n Βϋ n n ϋ n ϋ l_i I I n I ϋ ϋ n n 498050 C8 D8 六、申請專利範圍 物之傾斜度 | ·如申請專利範圍第2項所述之方法,其中該控制機構爲 無線控制機構。 40 - 本紙張文度適用中國國家標準(CNS)A4規格(210 x 297公釐) (請先閱讀背面之注意事項再填寫本頁) - 訂-----498050 iJU C8 D8 6. Application for patent scope 1. A suspension imbalance monitoring device for a tower crane, including: a rotation control structure including a motor, a driving component, an upper connecting element and a lower connecting element, wherein The upper connection element is used to connect with the crane hook, and the lower connection element is used to connect with the hanging object. When the motor rotates, the component is rotated by the force-reaction mechanism, and the component is connected with the lower connection device. A tilt control structure, which includes at least a motor, a driving component, and a lower connecting element, wherein when the motor rotates, the driving component can be driven to cause a change in distance, and the lower connecting element is connected to the driving component, The other end is connected to the hanging object, and the motor is directly and indirectly integrated with the motor of the rotation control structure; a wireless control component is used to start the motor of the rotation control structure by radio to achieve rotation of the hanging object Purpose, and / or control the motor of the tilting structure to achieve the purpose of tilting the hanging object. 2 · A method for monitoring the unbalance of a crane for a tower crane, comprising: suspending a hanging object on the unbalance of the crane, and directing the unbalance of the crane with a control mechanism to adjust a control mechanism The control mechanism and the suspension imbalance interact in a wireless or wired manner, which is characterized in that the control mechanism has a rotation control structure at a substantially central position. To • When necessary, it can rotate according to the instructions of the control mechanism, so that the hanging object rotates in the opposite direction; and at least one side of the control mechanism has a tilt control structure to accept the instructions of the control mechanism to adjust the suspension when necessary -39- This paper <Chongqingguanjiaxian (CNS) A4 size ⑵0x297 public) '-------- # --- (Please read the precautions on the back before filling this page) IH ϋ nn I ϋ ϋ .1 n Βϋ nn ϋ n ϋ l_i II n I ϋ ϋ nn 498050 C8 D8 6. Inclination of patent application scope | · The method described in item 2 of patent application scope, where the control mechanism is wireless Control agency. 40-This paper is written in Chinese National Standard (CNS) A4 (210 x 297 mm) (Please read the precautions on the back before filling this page)-Order -----
TW089128356A 2000-12-29 2000-12-29 Imbalance monitor device for tower-type crane TW498050B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW089128356A TW498050B (en) 2000-12-29 2000-12-29 Imbalance monitor device for tower-type crane

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW089128356A TW498050B (en) 2000-12-29 2000-12-29 Imbalance monitor device for tower-type crane

Publications (1)

Publication Number Publication Date
TW498050B true TW498050B (en) 2002-08-11

Family

ID=21662563

Family Applications (1)

Application Number Title Priority Date Filing Date
TW089128356A TW498050B (en) 2000-12-29 2000-12-29 Imbalance monitor device for tower-type crane

Country Status (1)

Country Link
TW (1) TW498050B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI382169B (en) * 2008-06-18 2013-01-11 Nat Univ Chung Hsing Apparatus of measuring momentum of inertial of human body
TWI613885B (en) * 2017-01-20 2018-02-01 國立高雄第一科技大學 Optimized energy saving method for dc fan motor under fixed rotational speed and chip of the dc fan motor
TWI756924B (en) * 2020-11-18 2022-03-01 李致祥 Electronic automatic balance control device

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI382169B (en) * 2008-06-18 2013-01-11 Nat Univ Chung Hsing Apparatus of measuring momentum of inertial of human body
TWI613885B (en) * 2017-01-20 2018-02-01 國立高雄第一科技大學 Optimized energy saving method for dc fan motor under fixed rotational speed and chip of the dc fan motor
TWI756924B (en) * 2020-11-18 2022-03-01 李致祥 Electronic automatic balance control device

Similar Documents

Publication Publication Date Title
CN105549386B (en) Ship&#39;s crane automatic experiment system
Kim et al. Performance studies of human operators driving double-pendulum bridge cranes
DK3077322T3 (en) Method for controlling a load
CN103274299B (en) Tower crane and rotation control system and rotation control method thereof
CN102539185B (en) Selenographic gravity simulation system for ground traveling tests of exploration rover
CN107010550A (en) A kind of counterweight can adjust cantilever type rotating crane
US7832711B2 (en) Control system for transfer means
US20130328290A1 (en) Adaptable vehicle
GB2467149A (en) Load Orientation Device
CN104440904A (en) Steel wire rope transmission mechanical hand
CN101419764A (en) Automatic experiment system for bridge type crane
TW498050B (en) Imbalance monitor device for tower-type crane
Seriani et al. Variable radius drum mechanisms
Xu et al. Dynamic obstacle-surmounting analysis of a bilateral-wheeled cable-climbing robot for cable-stayed bridges
US10538417B1 (en) Construction beam robot
Hu et al. Design and performance evaluation of a spherical robot assisted by high-speed rotating flywheels for self-stabilization and obstacle surmounting
CN204848060U (en) Cargo handling manipulator
Ebrahimi et al. Swing angle estimation for anti-sway overhead crane control using load cell
CN113950458A (en) Device for controlling a load suspended on a cable
CN116246514A (en) Four-bar portal port crane simulation experiment system and modeling method
Zhu et al. Dynamic characteristics of series-parallel hybrid rigid-flexible coupling double-mass underactuated system on floating platform
KR101405156B1 (en) Generating system
Wei et al. Walking Characteristics of Dual‐Arm Inspection Robot with Flexible‐Cable
Rahmani et al. A precise fuzzy controller developed for overhead crane
CN202895227U (en) Robot manipulator

Legal Events

Date Code Title Description
GD4A Issue of patent certificate for granted invention patent
MM4A Annulment or lapse of patent due to non-payment of fees