JP6824217B2 - Transport controller, method and program - Google Patents

Transport controller, method and program Download PDF

Info

Publication number
JP6824217B2
JP6824217B2 JP2018064602A JP2018064602A JP6824217B2 JP 6824217 B2 JP6824217 B2 JP 6824217B2 JP 2018064602 A JP2018064602 A JP 2018064602A JP 2018064602 A JP2018064602 A JP 2018064602A JP 6824217 B2 JP6824217 B2 JP 6824217B2
Authority
JP
Japan
Prior art keywords
transported
drive unit
target position
amplitude
cycle
Prior art date
Legal status (The legal status 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 status listed.)
Active
Application number
JP2018064602A
Other languages
Japanese (ja)
Other versions
JP2019172454A (en
Inventor
敬之 西
敬之 西
英行 唐木
英行 唐木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fujifilm Corp
Original Assignee
Fujifilm Corp
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 Fujifilm Corp filed Critical Fujifilm Corp
Priority to JP2018064602A priority Critical patent/JP6824217B2/en
Publication of JP2019172454A publication Critical patent/JP2019172454A/en
Application granted granted Critical
Publication of JP6824217B2 publication Critical patent/JP6824217B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control And Safety Of Cranes (AREA)

Description

本発明は、被搬送物を目標位置まで搬送する搬送制御装置、方法およびプログラムに関する。 The present invention relates to a transport control device, method and program for transporting an object to be transported to a target position.

懸架式クレーンにおいて被搬送物を搬送する搬送システムにおいては、被搬送物をクレーンに吊り下げ、被搬送物を吊り下げた状態で目標位置まで搬送し、目標位置において被搬送物を下ろすという一連の作業が繰り返される。しかしながら、搬送された被搬送物は、目標位置において停止させると、慣性の法則により揺動する。このため、被搬送物をクレーンから降ろす等の作業を継続するためには、揺動が停止するまで待つか、または揺動を強制的に停止させる作業を行う必要があり、その結果、作業時間が長くなる。このような一連の作業の作業時間を短縮するために、停止時における被搬送物の揺れを抑制する制御が行われている。例えば、特許文献1においては、被搬送物を水平方向に搬送する際の加減速時間を、被搬送物の揺れの周期と等しくすることにより、被搬送物の停止時の揺れを小さくする手法が提案されている。 In a transport system that transports an object to be transported by a suspended crane, the object to be transported is suspended from the crane, the object to be transported is transported to a target position while being suspended, and the object to be transported is lowered at the target position. The work is repeated. However, when the transported object is stopped at the target position, it swings according to the law of inertia. Therefore, in order to continue the work such as unloading the object to be transported from the crane, it is necessary to wait until the rocking stops or to forcibly stop the rocking, and as a result, the working time. Becomes longer. In order to shorten the work time of such a series of operations, control is performed to suppress the shaking of the object to be transported when stopped. For example, in Patent Document 1, there is a method of reducing the shaking when the transported object is stopped by making the acceleration / deceleration time when the transported object is transported in the horizontal direction equal to the shaking cycle of the transported object. Proposed.

特開2011−93633号公報Japanese Unexamined Patent Publication No. 2011-93633

しかしながら、特許文献1に記載された手法では、被搬送物の停止時の揺れの抑制が十分ではない。 However, the method described in Patent Document 1 does not sufficiently suppress the shaking of the transported object when it is stopped.

本発明は、上記事情に鑑みなされたものであり、被搬送物の停止時の揺れを十分に抑制できるようにすることを目的とする。 The present invention has been made in view of the above circumstances, and an object of the present invention is to be able to sufficiently suppress shaking when the transported object is stopped.

本発明による搬送制御装置は、被搬送物を揺動自在に吊り下げて、被搬送物を開始位置から目標位置まで搬送する搬送制御装置であって、
被搬送物が吊り下げられ、開始位置および目標位置を含む経路に沿って駆動される駆動部と、
nを自然数とした場合における被搬送物の揺動周期のn倍を基準とする所要時間により、駆動部を開始位置から目標位置を含む特定範囲内の位置まで移動させる第1工程、および第1工程の後に被搬送物の揺動周期よりも小さい周期、かつ第1工程における被搬送物の振幅よりも小さい振幅にて、駆動部を特定の回数往復移動させて、駆動部を目標位置に停止させる第2工程により、駆動部を駆動する制御部とを備える。
The transport control device according to the present invention is a transport control device that swingably suspends the transported object and transports the transported object from a start position to a target position.
A drive unit in which the object to be transported is suspended and driven along a path including a start position and a target position.
The first step of moving the drive unit from the start position to a position within a specific range including the target position according to the required time based on n times the swing cycle of the object to be transported when n is a natural number, and the first step. After the process, the drive unit is reciprocated a specific number of times with a period smaller than the swing period of the object to be transported and an amplitude smaller than the amplitude of the object to be transported in the first step, and the drive unit is stopped at the target position. A control unit that drives the drive unit is provided by the second step of making the drive unit.

「被搬送物の揺動周期」とは、吊り下げられた被搬送物を、実際に開始位置から目標位置まで、ある条件(速度、移動距離および所要時間等)により搬送して揺動させた場合における、揺動する周期の1周期分を意味する。揺動周期は、被搬送物の種類、大きさ、被搬送物の吊り下げ方、および吊り下げ位置から被搬送物の重心位置までの距離等に応じて異なるものとなる。被搬送物の揺動周期は、計算により算出してもよく、実際に計測することにより算出してもよい。なお、被搬送物を開始位置から目標位置まで搬送する間に、被搬送物が複数周期揺動する場合がある。この際、各周期の揺動時間が異なるものとなる可能性がある。このため、開始位置から目標位置までの間に被搬送物が複数周期揺動する場合、各周期を代表する周期(例えば周期の平均値、周期の中央値、周期の最大値、または周期の最小値等)を、被搬送物の揺動周期とすることが好ましい。 The "swing cycle of the object to be transported" means that the suspended object is actually transported from the start position to the target position under certain conditions (speed, moving distance, required time, etc.) and rocked. In the case, it means one cycle of the swinging cycle. The swing cycle differs depending on the type and size of the object to be transported, the method of suspending the object to be transported, the distance from the hanging position to the position of the center of gravity of the object to be transported, and the like. The swing period of the object to be transported may be calculated by calculation or may be calculated by actual measurement. While transporting the transported object from the start position to the target position, the transported object may swing for a plurality of cycles. At this time, the swing time of each cycle may be different. Therefore, when the transported object swings for multiple cycles from the start position to the target position, the cycles representing each cycle (for example, the average value of the cycles, the median of the cycles, the maximum value of the cycles, or the minimum of the cycles) Value, etc.) is preferably set to the swing period of the transported object.

「被搬送物の揺動周期のn倍を基準とする所要時間」とは、n倍の所要時間であることのみならず、例えば被搬送物の揺動周期のn倍に対して±10%等のある程度の誤差を持っていることをも含む。なお、n=1の場合、第1工程の所要時間の上限は被搬送物の揺動周期のn倍の+10%よりも大きい誤差を持っていてもよい。例えば、被搬送物の揺動周期のn倍の+25%の誤差を持っていてもよい。 The "required time based on n times the swing cycle of the transported object" is not only the required time of n times, but also ± 10% with respect to n times the rocking cycle of the transported object, for example. It also includes having some error such as. When n = 1, the upper limit of the time required for the first step may have an error larger than + 10%, which is n times the swing period of the object to be transported. For example, it may have an error of + 25%, which is n times the swing period of the object to be transported.

「第1工程における被搬送物の振幅」とは、被搬送物の揺動周期のn倍(nは自然数)を基準とする所要時間により、吊り下げられた被搬送物を開始位置から目標位置まで実際に搬送し、駆動部が目標位置において停止した状態おいて計測される、揺動する被搬送物の最大となる振幅を意味する。なお、目標位置において停止した被搬送物の揺れは時間の経過により減衰する。このため、本発明において第1工程における被搬送物の振幅は、駆動部が目標位置で停止した後において、被搬送物の速度が最初に0となった状態における、被搬送物の揺動の支点(すなわち、振り子の支点)を通る垂線と、被搬送物の基準点との間の距離とする。なお、被搬送物の基準点としては、被搬送物の重心、被搬送物における揺動の支点から最も離れた点等を用いることができる。 The "amplitude of the transported object in the first step" is the required time based on n times the swing period of the transported object (n is a natural number), and the suspended object is moved from the start position to the target position. It means the maximum amplitude of the swinging object to be transported, which is measured with the drive unit stopped at the target position. The shaking of the transported object stopped at the target position is attenuated with the passage of time. Therefore, in the present invention, the amplitude of the transported object in the first step is the swing of the transported object in a state where the speed of the transported object is first 0 after the drive unit is stopped at the target position. It is the distance between the perpendicular line passing through the fulcrum (that is, the fulcrum of the pendulum) and the reference point of the object to be transported. As the reference point of the transported object, the center of gravity of the transported object, the point farthest from the swing fulcrum of the transported object, or the like can be used.

「目標位置を含む特定範囲内の位置」とは、第1工程が終了する位置であり、目標位置そのものであってもよく、搬送方向に対して目標位置の手前の位置であってもよく、目標位置を通過した位置であってもよい。 The "position within a specific range including the target position" is a position where the first step ends, may be the target position itself, or may be a position before the target position with respect to the transport direction. It may be a position that has passed the target position.

第2工程の周期は、被搬送物の揺動周期より小さければよい。例えば、被搬送物の揺動周期の0.1倍以上0.9倍以下であってもよく、0.2倍以上0.8倍以下であってもよく、0.3倍以上0.7倍以下であってもよく、0.4倍以上0.6倍以下であってもよい。 The cycle of the second step may be smaller than the swing cycle of the object to be transported. For example, it may be 0.1 times or more and 0.9 times or less of the swing period of the transported object, 0.2 times or more and 0.8 times or less, and 0.3 times or more and 0.7 times. It may be double or less, and may be 0.4 times or more and 0.6 times or less.

第2工程の振幅は、被搬送物の振幅より小さければよい。例えば、被搬送物の振幅の0.1倍以上0.9倍以下であってもよく、0.2倍以上0.8倍以下であってもよく、0.3倍以上0.7倍以下であってもよく、0.4倍以上0.6倍以下であってもよい。 The amplitude of the second step may be smaller than the amplitude of the object to be transported. For example, the amplitude of the transported object may be 0.1 times or more and 0.9 times or less, 0.2 times or more and 0.8 times or less, and 0.3 times or more and 0.7 times or less. It may be 0.4 times or more and 0.6 times or less.

第2工程における「特定の回数」は、目標位置に到達した被搬送物の揺動を抑制できる回数であればよい。例えば、10回以下であってもよく、8回以下であってもよく、5回以下であってもよく、3回以下であってもよい。 The "specific number of times" in the second step may be any number as long as it can suppress the swing of the object to be transported that has reached the target position. For example, it may be 10 times or less, 8 times or less, 5 times or less, or 3 times or less.

なお、本発明による搬送制御装置においては、駆動部は、被搬送物を吊り下げるフックを備えるものであってもよい。 In the transport control device according to the present invention, the drive unit may include a hook for suspending the object to be transported.

また、本発明による搬送制御装置においては、駆動部は、被搬送物を被搬送物の移動方向において回動自在に吊り下げる吊り下げ機構を備えるものであってもよい。 Further, in the transport control device according to the present invention, the drive unit may be provided with a suspension mechanism for suspending the transported object so as to be rotatable in the moving direction of the transported object.

また、本発明による搬送制御装置においては、制御部は、駆動部が目標位置に到達すると同時に第2工程を開始するものであってもよい。 Further, in the transport control device according to the present invention, the control unit may start the second step as soon as the drive unit reaches the target position.

また、本発明による搬送制御装置においては、制御部は、目標位置よりも第2の工程振幅分手前の位置に駆動部が到達してから第2工程を開始するものであってもよい。 Further, in the transfer control device according to the present invention, the control unit may start the second process after the drive unit reaches a position before the target position by the second process amplitude.

なお、「手前」とは、搬送方向に対して目標位置よりも手前であることを意味する。したがって、「目標位置よりも第2工程の振幅分手前の位置に駆動部が到達してから第2工程を開始する」ことにより、駆動部が目標位置に到達する前に、第2工程を開始することとなる。 In addition, "front" means that it is in front of the target position with respect to the transport direction. Therefore, by "starting the second process after the drive unit reaches a position before the target position by the amplitude of the second process", the second process is started before the drive unit reaches the target position. Will be done.

また、本発明による搬送制御装置においては、制御部は、駆動部が目標位置に到達した後、特定の時間経過する前に、第2工程を開始するものであってもよい。特定の時間としては、6秒としてもよく、5秒としてもよく、4秒としてもよく、3秒としてもよく、2秒としてもよく、1秒としてもよい。また、被搬送物の固有周期との関係において、被搬送物は固有周期の1/4および3/4の周期において最大の振れ幅となる。このため、被搬送物の固有周期の1/4となる時間または3/4となる時間を特定の時間としてもよい。 Further, in the transport control device according to the present invention, the control unit may start the second step after the drive unit reaches the target position and before a specific time elapses. The specific time may be 6 seconds, 5 seconds, 4 seconds, 3 seconds, 2 seconds, or 1 second. Further, in relation to the natural period of the material to be transported, the material to be transported has the maximum swing width in the cycles of 1/4 and 3/4 of the natural cycle. Therefore, the time that becomes 1/4 or 3/4 of the natural period of the object to be transported may be set as a specific time.

また、本発明による搬送制御装置においては、制御部は、第2工程の開始時に、被搬送物が揺動する方向とは逆の方向に駆動部を移動させるものであってもよい。 Further, in the transfer control device according to the present invention, the control unit may move the drive unit in the direction opposite to the direction in which the object to be transported swings at the start of the second step.

本発明による搬送制御方法は、被搬送物を揺動自在に吊り下げて、被搬送物を開始位置から目標位置まで搬送する搬送制御方法であって、
被搬送物が吊り下げられ、開始位置および目標位置を含む経路に沿って駆動される駆動部を、被搬送物の揺動周期のn倍(nは自然数)を基準とする所要時間により、駆動部を開始位置から目標位置を含む特定範囲内の位置まで移動させる第1工程、および第1工程の後に被搬送物の揺動周期よりも小さい周期、かつ第1工程における被搬送物の振幅よりも小さい振幅にて、駆動部を特定の回数往復移動させて、駆動部を目標位置に停止させる第2工程により、駆動する。
The transport control method according to the present invention is a transport control method in which the transported object is swayably suspended and the transported object is transported from the start position to the target position.
The drive unit in which the object to be transported is suspended and driven along the path including the start position and the target position is driven by the required time based on n times the swing cycle of the object to be transported (n is a natural number). From the first step of moving the unit from the start position to a position within a specific range including the target position, and after the first step, a cycle smaller than the swing cycle of the transported object, and the amplitude of the transported object in the first step. It is driven by the second step of reciprocating the driving unit a specific number of times with a small amplitude and stopping the driving unit at the target position.

なお、本発明による搬送制御方法をコンピュータに実行させるためのプログラムとして提供してもよい。 It should be noted that it may be provided as a program for causing a computer to execute the transport control method according to the present invention.

本発明によれば、被搬送物の揺動周期のn倍(nは自然数)を基準とする所要時間により、駆動部を開始位置から目標位置を含む特定範囲内の位置まで移動させる第1工程、および第1工程の後に被搬送物の揺動周期よりも小さい周期、かつ第1工程における被搬送物の振幅よりも小さい振幅にて、駆動部を特定の回数往復移動させて駆動部を目標位置に停止させる第2工程により駆動部が駆動されて、被搬送物が搬送される。第1工程により、目標位置における被搬送物の揺れを抑制できるが、第2工程により被搬送物の揺れはさらに抑制される。したがって、本発明によれば、被搬送物の停止時の揺れを十分に抑制することができる。 According to the present invention, the first step of moving the drive unit from the start position to a position within a specific range including the target position according to the required time based on n times the swing period of the object to be transported (n is a natural number). , And after the first step, the drive unit is reciprocated a specific number of times with a period smaller than the swing period of the object to be transported and an amplitude smaller than the amplitude of the object to be transported in the first step to aim at the drive unit. The drive unit is driven by the second step of stopping at the position, and the object to be transported is conveyed. The first step can suppress the shaking of the transported object at the target position, but the second step further suppresses the shaking of the transported object. Therefore, according to the present invention, it is possible to sufficiently suppress the shaking of the transported object when it is stopped.

本発明の実施形態による搬送制御装置を適用した搬送装置の全体構成図Overall configuration diagram of the transport device to which the transport control device according to the embodiment of the present invention is applied. 制御部の構成を示す概略ブロック図Schematic block diagram showing the configuration of the control unit 駆動部の駆動パターンおよび駆動部の移動距離の例を示す図The figure which shows the example of the drive pattern of a drive part and the movement distance of a drive part 被搬送物の振幅を説明するための図Diagram for explaining the amplitude of the object to be transported 目標位置を含む特定範囲を説明するための図Diagram for explaining a specific range including the target position 本発明の実施例を示す表Table showing examples of the present invention

以下、図面を参照して本発明の実施形態について説明する。図1は本発明の実施形態による搬送制御装置を適用した搬送装置の全体構成図である。図1に示すように、本実施形態による搬送装置1は、2本の支柱2A,2B、2本の支柱2A,2Bの上端部のそれぞれ接続された、直線状の案内部材3、案内部材3に沿って移動される駆動部4、駆動部4を移動させるための移動機構5、および駆動部4の駆動を制御する制御部6を備える。なお、駆動部4および制御部6が本実施形態の搬送制御装置を構成する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings. FIG. 1 is an overall configuration diagram of a transport device to which the transport control device according to the embodiment of the present invention is applied. As shown in FIG. 1, the transport device 1 according to the present embodiment has a linear guide member 3 and a guide member 3 connected to the upper ends of two columns 2A and 2B and two columns 2A and 2B, respectively. It includes a drive unit 4 that is moved along the line, a moving mechanism 5 for moving the drive unit 4, and a control unit 6 that controls the drive of the drive unit 4. The drive unit 4 and the control unit 6 constitute the transfer control device of the present embodiment.

駆動部4を駆動する移動機構5は、モータ10、およびモータ10により回転されるボールネジ11を備える。モータ10は、駆動部4により搬送される被搬送物7の搬送の開始位置Psよりも搬送方向手前側において案内部材3に取り付けられている。ボールネジ11は案内部材3に沿って延在する。ボールネジ11の一端部はモータ10に接続されており、他端部は軸受12により回転自在に支持されている。軸受12は、被搬送物7の搬送方向において、搬送の目標位置Peを超えた位置において案内部材3に取り付けられている。これにより、モータ10を回転させることよりボールネジ11が回転されると、回転方向に応じた方向に、駆動部4が案内部材3に沿って移動する。なお、駆動部4には被搬送物7を吊り下げるためのフック4aが取り付けられている。 The moving mechanism 5 that drives the drive unit 4 includes a motor 10 and a ball screw 11 that is rotated by the motor 10. The motor 10 is attached to the guide member 3 on the front side in the transport direction from the transport start position Ps of the transported object 7 transported by the drive unit 4. The ball screw 11 extends along the guide member 3. One end of the ball screw 11 is connected to the motor 10, and the other end is rotatably supported by the bearing 12. The bearing 12 is attached to the guide member 3 at a position exceeding the target position Pe for transportation in the transport direction of the object to be transported 7. As a result, when the ball screw 11 is rotated by rotating the motor 10, the drive unit 4 moves along the guide member 3 in the direction corresponding to the rotation direction. A hook 4a for suspending the object to be transported 7 is attached to the drive unit 4.

また、モータ10にはエンコーダ13が接続されている。エンコーダ13は、モータ10の回転に応じた駆動部4の位置を検出し、検出信号を制御部6へ出力する。 Further, an encoder 13 is connected to the motor 10. The encoder 13 detects the position of the drive unit 4 according to the rotation of the motor 10 and outputs the detection signal to the control unit 6.

なお、駆動部4を移動させるための移動機構5は上記の構成に限定されるものではなく、駆動部4を案内部材3に沿って移動できれば、任意の構成を採用することができる。 The moving mechanism 5 for moving the drive unit 4 is not limited to the above configuration, and any configuration can be adopted as long as the drive unit 4 can be moved along the guide member 3.

被搬送物7は、本実施形態においては、例えば特開2011−183115号公報に記載された、内視鏡可撓管である。被搬送物7は保持部材8により保持されて、搬送される。保持部材8には、被搬送物7を保持する側とは反対側にフック8aが取り付けられている。保持部材8により保持された被搬送物7は、フック8aを駆動部4のフック4aに引っかけることにより、駆動部4に揺動自在に吊り下げられる。これにより、駆動部4を移動後に停止させると、慣性の法則により被搬送物7は揺動する。 In the present embodiment, the object to be transported 7 is, for example, an endoscopic flexible tube described in Japanese Patent Application Laid-Open No. 2011-183115. The object to be transported 7 is held by the holding member 8 and transported. A hook 8a is attached to the holding member 8 on the side opposite to the side that holds the object to be transported 7. The object to be transported 7 held by the holding member 8 is swayably suspended from the drive unit 4 by hooking the hook 8a on the hook 4a of the drive unit 4. As a result, when the drive unit 4 is stopped after moving, the object to be transported 7 swings according to the law of inertia.

図2は制御部の構成を示す概略ブロック図である。図2に示すように、制御部6は、CPU(Central Processing Unit)21、モーションコントローラ22、サーボアンプ23、および記憶部24を備える。また、制御部6にはキーボードおよびマウス等からなる入力部25、並びに液晶モニタ等からなる表示部26が接続されている。 FIG. 2 is a schematic block diagram showing the configuration of the control unit. As shown in FIG. 2, the control unit 6 includes a CPU (Central Processing Unit) 21, a motion controller 22, a servo amplifier 23, and a storage unit 24. Further, an input unit 25 including a keyboard, a mouse and the like, and a display unit 26 including a liquid crystal monitor and the like are connected to the control unit 6.

モーションコントローラ22は、CPU21からの指示により、モータ10を駆動するための駆動信号をサーボアンプ23に出力する。また、モーションコントローラ22には、サーボアンプ23を介して、駆動部4の位置を表す位置信号が入力される。モーションコントローラ22は入力された位置信号に応じて、モータ10を駆動するための駆動信号を出力する。 The motion controller 22 outputs a drive signal for driving the motor 10 to the servo amplifier 23 in response to an instruction from the CPU 21. Further, a position signal indicating the position of the drive unit 4 is input to the motion controller 22 via the servo amplifier 23. The motion controller 22 outputs a drive signal for driving the motor 10 according to the input position signal.

サーボアンプ23には、モーションコントローラ22からの駆動信号およびエンコーダ13からの検出信号が入力される。サーボアンプ23は駆動信号をモータ10へ出力し、これによりモータ10が回転して駆動部4を駆動する。 The drive signal from the motion controller 22 and the detection signal from the encoder 13 are input to the servo amplifier 23. The servo amplifier 23 outputs a drive signal to the motor 10, whereby the motor 10 rotates to drive the drive unit 4.

記憶部24は、半導体メモリからなり、駆動部4を駆動するための各種パターンが記憶されている。CPU21は記憶部24に記憶されたパターンを読み出し、モーションコントローラ22へ出力する。モーションコントローラ22は、入力されたパターンに応じた駆動信号を出力する。 The storage unit 24 is composed of a semiconductor memory, and various patterns for driving the drive unit 4 are stored. The CPU 21 reads out the pattern stored in the storage unit 24 and outputs it to the motion controller 22. The motion controller 22 outputs a drive signal according to the input pattern.

なお、制御部6を、CPU、半導体メモリおよびハードディスク等を備えたコンピュータから構成してもよい。この場合、ハードディスクに本発明の搬送制御プログラムがインストールされ、搬送制御プログラムにより駆動部4の駆動が制御される。 The control unit 6 may be composed of a computer including a CPU, a semiconductor memory, a hard disk, and the like. In this case, the transfer control program of the present invention is installed on the hard disk, and the transfer control program controls the drive of the drive unit 4.

次いで、本実施形態における駆動部4の駆動パターンについて説明する。本実施形態においては、制御部6は、第1工程および第2工程の2つの工程により駆動部4を駆動して、駆動部4を開始位置Psから目標位置Peまで移動することにより、被搬送物7を開始位置Psから目標位置Peまで搬送する。第1工程は、被搬送物7の揺動周期T1のn倍(nは自然数)を基準とする所要時間t0により、駆動部4を開始位置Psから目標位置Peを含む特定範囲内の位置まで移動させる。第1工程の後の第2工程は、被搬送物7の揺動周期T1よりも小さい周期T2、かつ第1工程における被搬送物7の振幅A1よりも小さい振幅A2にて、駆動部4を特定の回数往復移動させて、駆動部4を目標位置Peに停止させる。 Next, the drive pattern of the drive unit 4 in the present embodiment will be described. In the present embodiment, the control unit 6 drives the drive unit 4 by two steps of the first step and the second step, and moves the drive unit 4 from the start position Ps to the target position Pe to be transported. The object 7 is conveyed from the start position Ps to the target position Pe. In the first step, the drive unit 4 is moved from the start position Ps to a position within a specific range including the target position Pe by the required time t0 based on n times the rocking period T1 of the object to be transported 7 (n is a natural number). Move. In the second step after the first step, the drive unit 4 is driven by a period T2 smaller than the swing period T1 of the object to be transported 7 and an amplitude A2 smaller than the amplitude A1 of the object 7 to be transported in the first step. The drive unit 4 is stopped at the target position Pe by reciprocating a specific number of times.

図3は駆動部4の駆動パターンおよび駆動部4の移動距離の例を示す図である。なお、図3の上側の図において縦軸は駆動部4の速度を、横軸は時間を示す。図3の下側の図において、縦軸は駆動部4の移動距離を、横軸は時間を示す。図3に示すように、駆動部4は、区間z1において加速され、区間z2において定速走行する。そして、区間z3において減速され、停止後に区間z4において特定回数(ここでは3回)往復移動する。この結果、第2工程の開始時には被搬送物7が揺動する方向とは逆の方向に駆動部4が駆動される。図3における区間z1,z2,z3が第1工程の区間であり、区間z4が第2工程の区間である。第2工程終了時において、駆動部4は目標位置Peに停止する。 FIG. 3 is a diagram showing an example of the drive pattern of the drive unit 4 and the moving distance of the drive unit 4. In the upper diagram of FIG. 3, the vertical axis represents the speed of the drive unit 4, and the horizontal axis represents time. In the lower view of FIG. 3, the vertical axis represents the moving distance of the drive unit 4, and the horizontal axis represents time. As shown in FIG. 3, the drive unit 4 is accelerated in the section z1 and travels at a constant speed in the section z2. Then, it is decelerated in the section z3, and after stopping, it reciprocates a specific number of times (here, 3 times) in the section z4. As a result, at the start of the second step, the drive unit 4 is driven in the direction opposite to the direction in which the object to be transported 7 swings. In FIG. 3, sections z1, z2, and z3 are sections of the first step, and section z4 is a section of the second step. At the end of the second step, the drive unit 4 stops at the target position Pe.

ここで、被搬送物7の固有周期は、T1=2π√(l/g)により表される。gは重力加速度であり、lは被搬送物7の揺動の支点P0(図1参照)から被搬送物7の重心G0までの距離である。本実施形態において、被搬送物7の揺動周期T1は固有周期とは異なり、被搬送物7を実際に吊り下げて、ある条件(速度、移動距離および所要時間等)により搬送し、その際の揺れを計測することによって求める。具体的には、静止状態にある被搬送物7を、開始位置Psから目標位置Peまで搬送し、搬送を開始してから被搬送物7が揺動の支点P0を通る垂線L1と2回重なるまでの時間、すなわち搬送中における被搬送物7の揺動の1周期を、揺動周期T1として求める。なお、被搬送物7を開始位置Psから目標位置Peまで搬送する間に、被搬送物7が1周期分揺動しない場合がある。ここで、搬送を開始してから被搬送物7が最大振幅となるまでの時間は揺動周期T1の1/4であり、搬送を開始してから被搬送物7が揺動の支点P0を通る垂線L1と1回重なるまでの時間は揺動周期T1の1/2である。このため、被搬送物7を開始位置Psから目標位置Peまで搬送する間に被搬送物7が1周期分揺動しない場合、計測された周期の1周期に対する割合に応じた値を、計測された周期に乗算することにより、揺動周期T1を求めればよい。例えば、計測された周期が1周期の1/4である場合、それを4倍することにより揺動周期T1を求めればよい。また、計測された周期が1周期の1/2である場合、それを2倍することにより揺動周期T1を求めればよい。 Here, the natural period of the object to be transported 7 is represented by T1 = 2π√ (l / g). g is the gravitational acceleration, and l is the distance from the fulcrum P0 (see FIG. 1) of the swing of the transported object 7 to the center of gravity G0 of the transported object 7. In the present embodiment, the swing period T1 of the object to be transported 7 is different from the natural period, and the object to be transported 7 is actually suspended and transported under certain conditions (speed, moving distance, required time, etc.). Obtained by measuring the shaking of. Specifically, the object to be transported 7 in a stationary state is transported from the start position Ps to the target position Pe, and after the transfer is started, the object to be transported 7 overlaps with the perpendicular line L1 passing through the fulcrum P0 of the swing twice. The time until, that is, one cycle of the swing of the object to be transported 7 during transportation is determined as the swing cycle T1. While the transported object 7 is being transported from the start position Ps to the target position Pe, the transported object 7 may not swing for one cycle. Here, the time from the start of transport until the transported object 7 reaches the maximum amplitude is 1/4 of the swing period T1, and the transported object 7 sets the swing fulcrum P0 after the start of transport. The time until it overlaps with the perpendicular line L1 passing through once is 1/2 of the swing period T1. Therefore, when the transported object 7 does not swing for one cycle while the transported object 7 is transported from the start position Ps to the target position Pe, a value corresponding to the ratio of the measured cycle to one cycle is measured. The swing period T1 may be obtained by multiplying the period. For example, when the measured cycle is 1/4 of one cycle, the swing cycle T1 may be obtained by multiplying it by four. Further, when the measured cycle is 1/2 of one cycle, the swing cycle T1 may be obtained by doubling it.

なお、被搬送物7を開始位置Psから目標位置Peまで搬送する間に、被搬送物7が複数周期揺動する場合があるが、各周期の揺動時間が異なるものとなる可能性がある。このため、開始位置Psから目標位置Peまで被搬送物7が複数周期揺動する場合、各周期を代表する周期(例えば周期の平均値、周期の中央値、周期の最大値、または周期の最小値等)を、被搬送物7の揺動周期T1として求めることが好ましい。また、被搬送物7を開始位置Psから目標位置Peまで搬送する間に、被搬送物7が整数とはならない回数の周期(例えば1.25周期および1.5周期等)で揺動する場合がある。このような場合、計測された周期をその1周期に対する倍率によって除算することにより、揺動周期T1を求めればよい。例えば、計測された周期が被搬送物7の1.5周期である場合、計測された周期を1.5により除算することにより、揺動周期T1を求めることができる。 While the transported object 7 is transported from the start position Ps to the target position Pe, the transported object 7 may swing for a plurality of cycles, but the swing time for each cycle may be different. .. Therefore, when the transported object 7 swings in a plurality of cycles from the start position Ps to the target position Pe, the cycles representing each cycle (for example, the average value of the cycles, the median of the cycles, the maximum value of the cycles, or the minimum of the cycles) (Value, etc.) is preferably determined as the swing period T1 of the object to be transported 7. Further, when the transported object 7 swings in a cycle (for example, 1.25 cycle and 1.5 cycle, etc.) that does not become an integer while the transported object 7 is transported from the start position Ps to the target position Pe. There is. In such a case, the swing period T1 may be obtained by dividing the measured period by a magnification with respect to the one period. For example, when the measured cycle is 1.5 cycles of the object to be transported 7, the swing cycle T1 can be obtained by dividing the measured cycle by 1.5.

また、本実施形態において、第1工程の所要時間t0はn×T1に対してある程度の誤差を持っていてもよい。例えば、n×T1に対して±10%程度の誤差を持っていてもよい。すなわち、0.9×n×T1≦t0≦1.1×n×T1であってもよい。なお、n=1の場合、第1工程の所要時間t0の上限は10%よりも大きい誤差を持っていてもよい。例えば、25%の誤差を持っていてもよい。この場合、0.9×T1≦t0≦1.25×T1である。 Further, in the present embodiment, the time required t0 of the first step may have some error with respect to n × T1. For example, it may have an error of about ± 10% with respect to n × T1. That is, it may be 0.9 × n × T1 ≦ t0 ≦ 1.1 × n × T1. When n = 1, the upper limit of the required time t0 in the first step may have an error larger than 10%. For example, it may have an error of 25%. In this case, 0.9 × T1 ≦ t0 ≦ 1.25 × T1.

第2工程における駆動部4の周期T2は、被搬送物7の揺動周期T1よりも小さい。すなわち、T2=k1×T1(0<k1<1)である。なお、0.1≦k1≦0.9であってもよく、0.2≦k1≦0.8であってもよく、0.3≦k1≦0.7であってもよく、0.4≦k1≦0.6であってもよい。 The period T2 of the drive unit 4 in the second step is smaller than the swing period T1 of the object to be transported 7. That is, T2 = k1 × T1 (0 <k1 <1). It should be noted that 0.1 ≦ k1 ≦ 0.9, 0.2 ≦ k1 ≦ 0.8, 0.3 ≦ k1 ≦ 0.7, and 0.4 ≦ k1 ≦ 0.7. ≦ k1 ≦ 0.6 may be set.

また、第1工程における被搬送物7の振幅A1は、実際に駆動部4に被搬送物7を吊り下げ、上述したように算出した所要時間t0により開始位置Psから目標位置Peまで被搬送物7を搬送し、目標位置Peにおいて駆動部4を停止した状態において計測する。ここで、目標位置Peにおいて停止した被搬送物7の揺れは、時間の経過により減衰する。すなわち、図4に示すように、被搬送物7は、目標位置Peにおいて停止した直後に最も大きい振幅にて揺動する。本実施形態においては、この振幅の最大値を第1工程における被搬送物7の振幅A1とする。なお、振幅A1は、第1工程において駆動部4が停止した後、速度が最初に0となった状態における、被搬送物7の基準点、すなわち被搬送物7の揺動の支点P0とは反対側の端部の中心点P1と、被搬送物7の揺動の支点P0を通る垂線L1との距離である。なお、被搬送物7の基準点としては、被搬送物7の重心G0を用いてもよい。 Further, the amplitude A1 of the object to be transported 7 in the first step actually suspends the object to be transported 7 from the drive unit 4, and the object to be transported from the start position Ps to the target position Pe by the required time t0 calculated as described above. 7 is conveyed, and measurement is performed in a state where the drive unit 4 is stopped at the target position Pe. Here, the shaking of the object to be transported 7 stopped at the target position Pe is attenuated with the passage of time. That is, as shown in FIG. 4, the object to be transported 7 swings with the largest amplitude immediately after stopping at the target position Pe. In the present embodiment, the maximum value of this amplitude is the amplitude A1 of the object to be transported 7 in the first step. The amplitude A1 is the reference point of the object to be transported 7, that is, the fulcrum P0 of the swing of the object to be transported 7 in the state where the speed is first 0 after the drive unit 4 is stopped in the first step. It is the distance between the center point P1 of the opposite end and the perpendicular line L1 passing through the fulcrum P0 of the swing of the object to be transported 7. The center of gravity G0 of the transported object 7 may be used as the reference point of the transported object 7.

第2工程における駆動部4の振幅A2は、第1工程における被搬送物7の振幅A1よりも小さい。すなわち、A2=k2×A1(0<k2<1)である。なお、0.1≦k2≦0.9であってもよく、0.2≦k2≦0.8であってもよく、0.3≦k2≦0.7であってもよく、0.4≦k2≦0.6であってもよい。 The amplitude A2 of the drive unit 4 in the second step is smaller than the amplitude A1 of the object 7 to be transported in the first step. That is, A2 = k2 × A1 (0 <k2 <1). It should be noted that 0.1 ≦ k2 ≦ 0.9, 0.2 ≦ k2 ≦ 0.8, 0.3 ≦ k2 ≦ 0.7, and 0.4 ≦ k2 ≦ 0.7. ≦ k2 ≦ 0.6 may be set.

第2工程における駆動部4の往復移動回数は、実験的に定めればよい。例えば、10回以下であってもよく、8回以下であってもよく、5回以下であってもよく、3回以下であってもよい。 The number of reciprocating movements of the drive unit 4 in the second step may be determined experimentally. For example, it may be 10 times or less, 8 times or less, 5 times or less, or 3 times or less.

第1工程により駆動部4を移動させる最終位置は、目標位置Peを含む特定範囲内の位置である。図5は目標位置Peを含む特定範囲を説明するための図である。図5に示すように、特定範囲は目標位置Peを中心とした±A2の範囲である。なお、図5においては目標位置Peよりも手前の位置を負で示し、目標位置Peを超えた位置を正で示している。この範囲であれば、第1工程を終了して第2工程を開始してもよい。すなわち、第2工程の終了後に駆動部4が目標位置Peに到達していれば、第1工程により駆動部4を目標位置Peまで移動した後に第2工程を開始してもよく、目標位置Peよりも第2工程の振幅A2分手前の位置において第2工程を開始してもよく、目標位置Peを第2工程の振幅A2分通過した位置において第2工程を開始してもよい。 The final position for moving the drive unit 4 in the first step is a position within a specific range including the target position Pe. FIG. 5 is a diagram for explaining a specific range including the target position Pe. As shown in FIG. 5, the specific range is a range of ± A2 centered on the target position Pe. In FIG. 5, the position in front of the target position Pe is shown negatively, and the position beyond the target position Pe is shown positively. Within this range, the first step may be completed and the second step may be started. That is, if the drive unit 4 has reached the target position Pe after the end of the second step, the second process may be started after moving the drive unit 4 to the target position Pe by the first step, and the target position Pe may be started. The second step may be started at a position two minutes before the amplitude A2 of the second step, or the second step may be started at a position where the target position Pe has passed the amplitude A2 minutes of the second step.

なお、本実施形態においては、第1工程により駆動部4を目標位置Peにおいて停止させた後、特定の時間経過する前に第2工程を開始してもよい。特定時間としては、6秒としてもよく、5秒としてもよく、4秒としてもよく、3秒としてもよく、2秒としてもよく、1秒としてもよい。また、被搬送物7の固有周期との関係において、被搬送物7は固有周期の1/4および3/4の周期において最大の振れ幅となる。このため、被搬送物7の固有周期の1/4となる時間または3/4となる時間を特定の時間としてもよい。 In the present embodiment, after the drive unit 4 is stopped at the target position Pe by the first step, the second step may be started before a specific time elapses. The specific time may be 6 seconds, 5 seconds, 4 seconds, 3 seconds, 2 seconds, or 1 second. Further, in relation to the natural period of the transported object 7, the transported object 7 has the maximum swing width in the cycles of 1/4 and 3/4 of the natural cycle. Therefore, the time that becomes 1/4 or 3/4 of the natural period of the object to be transported 7 may be set as a specific time.

本実施形態においては、被搬送物7の揺動周期T1のn倍(nは自然数)を基準とする所要時間t0により、駆動部4を開始位置Psから目標位置Peを含む特定範囲内の位置まで移動させる第1工程、および第1工程の後に被搬送物7の揺動周期T1よりも小さい周期T2、かつ第1工程における被搬送物7の振幅A1よりも小さい振幅A2にて、目標位置Peにおいて駆動部4を特定の回数往復移動させて駆動部4を目標位置Peに停止させる第2工程により駆動部4を駆動して、被搬送物7を搬送するようにした。ここで、第1工程により、目標位置Peにおける被搬送物7の揺れを抑制できるが、第2工程により被搬送物7の揺れはさらに抑制される。したがって、本実施形態によれば、被搬送物7の停止時の揺れを十分に抑制することができる。 In the present embodiment, the drive unit 4 is positioned within a specific range including the target position Pe from the start position Ps by the required time t0 based on n times the swing period T1 of the object to be transported 7 (n is a natural number). In the first step of moving to, and after the first step, the target position has a period T2 smaller than the swing period T1 of the transported object 7 and an amplitude A2 smaller than the amplitude A1 of the transported object 7 in the first step. In Pe, the drive unit 4 is reciprocated a specific number of times to stop the drive unit 4 at the target position Pe, and the drive unit 4 is driven to convey the object to be transported 7. Here, the first step can suppress the shaking of the transported object 7 at the target position Pe, but the second step further suppresses the shaking of the transported object 7. Therefore, according to the present embodiment, it is possible to sufficiently suppress the shaking of the transported object 7 when it is stopped.

次いで、本発明の実施例について説明する。本発明の実施例を説明するための表を図6に示す。図6においては、1つの比較例1および9つの実施例1〜9を示している。比較例1および実施例1〜9においては、搬送距離はいずれも1mである。比較例1および実施例1〜5,7〜9においては、被搬送物7は長さ1.5m、直径15mmの内視鏡の可撓管であり、実施例6においては、被搬送物7は長さ0.5m、直径15mmの内視鏡の可撓管である。このため、比較例1および実施例1〜9において、固有周期は2.30秒であるが、実施例6においては固有周期は1.40秒である。第1工程に関して、比較例1および実施例1〜5,7〜9においては、図3に示す区間z1が1.2秒、区間z2における搬送速度が0.45m/秒、区間z3が1.2秒である。実施例6においては、図3に示す区間z1が1.3秒、区間z2における搬送速度が0.45m/秒、区間z3が1.3秒である。 Next, examples of the present invention will be described. A table for explaining an embodiment of the present invention is shown in FIG. In FIG. 6, one Comparative Example 1 and nine Examples 1 to 9 are shown. In Comparative Example 1 and Examples 1 to 9, the transport distance is 1 m. In Comparative Example 1 and Examples 1 to 5, 7 to 9, the object to be transported 7 is a flexible tube of an endoscope having a length of 1.5 m and a diameter of 15 mm, and in Example 6, the object to be transported 7 is a flexible tube. Is a flexible tube for an endoscope having a length of 0.5 m and a diameter of 15 mm. Therefore, in Comparative Example 1 and Examples 1 to 9, the natural period is 2.30 seconds, but in Example 6, the natural period is 1.40 seconds. Regarding the first step, in Comparative Example 1 and Examples 1 to 5, 7 to 9, the section z1 shown in FIG. 3 is 1.2 seconds, the transport speed in the section z2 is 0.45 m / sec, and the section z3 is 1. 2 seconds. In the sixth embodiment, the section z1 shown in FIG. 3 is 1.3 seconds, the transport speed in the section z2 is 0.45 m / sec, and the section z3 is 1.3 seconds.

図6において、第1工程における「差」は、揺動周期T1×n(n=1)から所要時間t0を減算した値である。比較例1および実施例1〜9において、差はいずれも揺動周期T1×n(n=1)の±10%の範囲にある。また、図6において結果の欄は、搬送終了時、すなわち第2工程終了時における被搬送物7の振幅を示す。比較例1は第2工程を行っていないため、比較例1の結果の欄は、第1工程の終了時における被搬送物7の振幅A1を示す。 In FIG. 6, the “difference” in the first step is a value obtained by subtracting the required time t0 from the swing period T1 × n (n = 1). In Comparative Example 1 and Examples 1 to 9, the difference is in the range of ± 10% of the swing period T1 × n (n = 1). Further, in FIG. 6, the result column shows the amplitude of the object to be transported 7 at the end of transportation, that is, at the end of the second step. Since the second step is not performed in Comparative Example 1, the column of the result of Comparative Example 1 shows the amplitude A1 of the object to be transported 7 at the end of the first step.

第2工程の周期T2に関して、実施例1,2,4〜6,8,9は0.54秒、実施例3は0.43秒、実施例7は1.79秒であり、いずれも第1工程における被搬送物7の揺動周期T1よりも小さい。また、振幅A2に関して、実施例1,2,4〜7,9は7.5mm、実施例3は6mm、実施例8は15mmであり、比較例1の結果、すなわち第2工程がない場合の第1工程における被搬送物7の振幅である25mmよりも小さい。また、往復移動の回数に関して、実施例1,3〜6は3回、実施例2,7,8は10回、実施例9は5回である。 Regarding the cycle T2 of the second step, Examples 1, 2, 4 to 6, 8 and 9 are 0.54 seconds, Example 3 is 0.43 seconds, and Example 7 is 1.79 seconds. It is smaller than the swing period T1 of the object to be transported 7 in one step. Further, regarding the amplitude A2, Examples 1, 2, 4 to 7, 9 are 7.5 mm, Example 3 is 6 mm, and Example 8 is 15 mm, which is the result of Comparative Example 1, that is, when there is no second step. It is smaller than 25 mm, which is the amplitude of the object to be transported 7 in the first step. Further, regarding the number of reciprocating movements, Examples 1, 3 to 6 are 3 times, Examples 2, 7 and 8 are 10 times, and Example 9 is 5 times.

また、実施例1〜3,6〜9の第2工程の開始位置における「同時」とは、駆動部4が目標位置Peに到達すると同時に第2工程を開始したことを示す。実施例4の「7.5mm手前」とは、駆動部4が目標位置Peに到達する7.5mm手前から第2工程を開始したことを示す。実施例4の開始位置における7.5mmは、実施例4における第2工程の振幅A2の大きさと同一である。実施例5の「5秒後」とは、駆動部4が目標位置Peに到達してから5秒後に第2工程を開始したことを示す。 Further, "simultaneously" at the start position of the second step of Examples 1 to 3, 6 to 9 means that the second step is started at the same time when the drive unit 4 reaches the target position Pe. “7.5 mm before” in the fourth embodiment means that the second step is started from 7.5 mm before the drive unit 4 reaches the target position Pe. The 7.5 mm at the start position of Example 4 is the same as the magnitude of the amplitude A2 of the second step in Example 4. “5 seconds later” in the fifth embodiment means that the second step is started 5 seconds after the drive unit 4 reaches the target position Pe.

図6の結果の欄に示すように、本実施形態のように第1工程に加えて第2工程を行うことにより、目標位置Peに搬送した際の被搬送物7の振幅を、25mmよりも小さくすることができた。また、実施例4に示すように、目標位置Peよりも第2工程の振幅A2分手前の位置に駆動部4が到達してから第2工程を開始することによっても、目標位置Peに搬送した際の被搬送物7の振幅を、25mmよりも小さくすることができた。また、実施例5に示すように、駆動部4が目標位置Peに到達した後、特定の時間経過する前に、第2工程を開始しても、目標位置Peに搬送した際の被搬送物7の振幅を、25mmよりも小さくすることができた。 As shown in the column of the result of FIG. 6, by performing the second step in addition to the first step as in the present embodiment, the amplitude of the object to be transported 7 when transported to the target position Pe is set to be larger than 25 mm. I was able to make it smaller. Further, as shown in the fourth embodiment, the driving unit 4 is also conveyed to the target position Pe by starting the second process after the drive unit 4 reaches a position two minutes before the amplitude A2 of the second step from the target position Pe. The amplitude of the object to be transported 7 could be made smaller than 25 mm. Further, as shown in the fifth embodiment, even if the second step is started after the drive unit 4 reaches the target position Pe and before a specific time elapses, the object to be transported when it is conveyed to the target position Pe. The amplitude of 7 could be made smaller than 25 mm.

なお、上記実施形態においては、駆動部4にフック4aを取り付け、フック4aに保持部材8のフック8aを引っかけて、駆動部4に被搬送物7を吊り下げているが、これに限定されるものではない。例えば、被搬送物7をその移動方向において回動自在に吊り下げることが可能な任意の機構を用いることができる。 In the above embodiment, the hook 4a is attached to the drive unit 4, the hook 8a of the holding member 8 is hooked on the hook 4a, and the object to be transported 7 is suspended from the drive unit 4, but the present invention is limited to this. It's not a thing. For example, any mechanism capable of rotatably suspending the object to be transported 7 in the moving direction can be used.

また、上記実施形態においては、直線状の案内部材3に沿って被搬送物7を搬送しているが、被搬送物7の搬送経路は直線状に限定されるものではなく、曲線状であってもよく、直線と曲線とを含む経路であってもよい。また、被搬送物7の高さが変化するような経路であってもよい。 Further, in the above embodiment, the object to be transported 7 is transported along the linear guide member 3, but the transport path of the object to be transported 7 is not limited to a straight line but is curved. It may be a path including a straight line and a curved line. Further, the route may be such that the height of the object to be transported 7 changes.

1 搬送装置
2A,2B 支柱
3 案内部材
4 駆動部
4a フック
5 移動機構
6 制御部
7 被搬送物
8 保持部材
8a フック
10 モータ
11 ボールネジ
12 軸受
13 エンコーダ
21 CPU
22 モーションコントローラ
23 サーボアンプ
24 記憶部
25 入力部
26 表示部
G0 被搬送物の重心
P0 揺動の支点
P1 被搬送物の揺動の視点から最も離れた位置における中心点
Ps 開始位置
Pe 目標位置
1 Transport device 2A, 2B Strut 3 Guide member 4 Drive unit 4a Hook 5 Movement mechanism 6 Control unit 7 Transported object 8 Holding member 8a Hook 10 Motor 11 Ball screw 12 Bearing 13 Encoder 21 CPU
22 Motion controller 23 Servo amplifier 24 Storage unit 25 Input unit 26 Display unit G0 Center of gravity of the object to be transported P0 fulcrum of swing P1 Center point at the position farthest from the viewpoint of swing of the object to be transported Ps Start position Pe Target position

Claims (9)

被搬送物を揺動自在に吊り下げて、前記被搬送物を開始位置から目標位置まで搬送する搬送制御装置であって、
前記被搬送物が吊り下げられ、前記開始位置および前記目標位置を含む経路に沿って駆動される駆動部と、
nを自然数とした場合における前記被搬送物の揺動周期のn倍を基準とする所要時間により、前記駆動部を前記開始位置から前記目標位置を含む特定範囲内の位置まで移動させる第1工程、および前記第1工程の後に、前記被搬送物の揺動周期よりも小さい周期、かつ前記第1工程における前記被搬送物の振幅よりも小さい振幅にて、前記駆動部を特定の回数往復移動させて、前記駆動部を前記目標位置に停止させる第2工程により、前記駆動部を駆動する制御部とを備えた搬送制御装置。
A transport control device that swingably suspends the transported object and transports the transported object from a start position to a target position.
A drive unit in which the object to be transported is suspended and driven along a path including the start position and the target position.
The first step of moving the drive unit from the start position to a position within a specific range including the target position according to the required time based on n times the swing cycle of the object to be transported when n is a natural number. , And, after the first step, the drive unit is reciprocated a specific number of times with a cycle smaller than the swing cycle of the object to be transported and an amplitude smaller than the amplitude of the object to be transported in the first step. A transport control device including a control unit that drives the drive unit by a second step of stopping the drive unit at the target position.
前記駆動部は、前記被搬送物を吊り下げるフックを備えた請求項1に記載の搬送制御装置。 The transport control device according to claim 1, wherein the drive unit includes a hook for suspending the object to be transported. 前記駆動部は、前記被搬送物を前記被搬送物の移動方向において回動自在に吊り下げる吊り下げ機構を備えた請求項1に記載の搬送制御装置。 The transport control device according to claim 1, wherein the drive unit includes a suspension mechanism for suspending the transported object so as to be rotatable in the moving direction of the transported object. 前記制御部は、前記駆動部が前記目標位置に到達すると同時に前記第2工程を開始する請求項1から3のいずれか1項に記載の搬送制御装置。 The transfer control device according to any one of claims 1 to 3, wherein the control unit starts the second step at the same time when the drive unit reaches the target position. 前記制御部は、前記目標位置よりも前記第2工程の振幅分手前の位置に前記駆動部が到達してから前記第2工程を開始する請求項1から3のいずれか1項に記載の搬送制御装置。 The transport according to any one of claims 1 to 3, wherein the control unit starts the second step after the drive unit reaches a position before the target position by the amplitude of the second step. Control device. 前記制御部は、前記駆動部が前記目標位置に到達した後、特定の時間経過する前に、前記第2工程を開始する請求項1から3のいずれか1項に記載の搬送制御装置。 The transport control device according to any one of claims 1 to 3, wherein the control unit starts the second step after the drive unit reaches the target position and before a specific time elapses. 前記制御部は、前記第2工程の開始時に、前記被搬送物が揺動する方向とは逆の方向に前記駆動部を移動させる請求項1から6のいずれか1項に記載の搬送制御装置。 The transport control device according to any one of claims 1 to 6, wherein the control unit moves the drive unit in a direction opposite to the direction in which the transported object swings at the start of the second step. .. 被搬送物を揺動自在に吊り下げて、前記被搬送物を開始位置から目標位置まで搬送する搬送制御方法であって、
前記被搬送物が吊り下げられ、前記開始位置および前記目標位置を含む経路に沿って駆動される駆動部を、nを自然数とした場合における前記被搬送物の揺動周期のn倍を基準とする所要時間により、前記駆動部を前記開始位置から前記目標位置を含む特定範囲内の位置まで移動させる第1工程、および前記第1工程の後に、前記被搬送物の揺動周期よりも小さい周期、かつ前記第1工程における前記被搬送物の振幅よりも小さい振幅にて、前記駆動部を特定の回数往復移動させて、前記駆動部を前記目標位置に停止させる第2工程により、駆動する搬送制御方法。
This is a transport control method in which the object to be transported is swayably suspended and the object to be transported is transported from a start position to a target position.
The drive unit in which the object to be transported is suspended and driven along a path including the start position and the target position is based on n times the swing cycle of the object to be transported when n is a natural number. The first step of moving the drive unit from the start position to a position within a specific range including the target position, and after the first step, a cycle smaller than the swing cycle of the object to be transported, depending on the required time. In addition, the transport is driven by the second step of reciprocating the drive unit a specific number of times with an amplitude smaller than the amplitude of the object to be transported in the first step and stopping the drive unit at the target position. Control method.
被搬送物を揺動自在に吊り下げて、前記被搬送物を開始位置から目標位置まで搬送する搬送制御方法をコンピュータに実行させる搬送制御プログラムであって、
前記被搬送物が吊り下げられ、前記開始位置および前記目標位置を含む経路に沿って駆動される駆動部を、nを自然数とした場合における前記被搬送物の揺動周期のn倍を基準とする所要時間により、前記駆動部を前記開始位置から前記目標位置を含む特定範囲内の位置まで移動させる第1工程、および前記第1工程の後に、前記被搬送物の揺動周期よりも小さい周期、かつ前記第1工程における前記被搬送物の振幅よりも小さい振幅にて、前記駆動部を特定の回数往復移動させて、前記駆動部を前記目標位置に停止させる第2工程により、駆動する処理をコンピュータに実行させる搬送制御プログラム。
A transfer control program that causes a computer to execute a transfer control method in which an object to be conveyed is swayably suspended and the object to be conveyed is conveyed from a start position to a target position.
The drive unit in which the object to be transported is suspended and driven along a path including the start position and the target position is based on n times the swing cycle of the object to be transported when n is a natural number. The first step of moving the drive unit from the start position to a position within a specific range including the target position, and after the first step, a cycle smaller than the swing cycle of the object to be transported, depending on the required time. The process of driving the drive unit by a second step of reciprocating the drive unit a specific number of times with an amplitude smaller than the amplitude of the object to be transported in the first step and stopping the drive unit at the target position. A transport control program that causes a computer to execute.
JP2018064602A 2018-03-29 2018-03-29 Transport controller, method and program Active JP6824217B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018064602A JP6824217B2 (en) 2018-03-29 2018-03-29 Transport controller, method and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018064602A JP6824217B2 (en) 2018-03-29 2018-03-29 Transport controller, method and program

Publications (2)

Publication Number Publication Date
JP2019172454A JP2019172454A (en) 2019-10-10
JP6824217B2 true JP6824217B2 (en) 2021-02-03

Family

ID=68168127

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018064602A Active JP6824217B2 (en) 2018-03-29 2018-03-29 Transport controller, method and program

Country Status (1)

Country Link
JP (1) JP6824217B2 (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7326089B2 (en) * 2019-09-24 2023-08-15 株式会社三共 game machine
JP7326090B2 (en) * 2019-09-24 2023-08-15 株式会社三共 game machine
JP2021049117A (en) * 2019-09-25 2021-04-01 株式会社三共 Game machine
JP2021049118A (en) * 2019-09-25 2021-04-01 株式会社三共 Game machine
JP7326092B2 (en) * 2019-09-25 2023-08-15 株式会社三共 game machine

Also Published As

Publication number Publication date
JP2019172454A (en) 2019-10-10

Similar Documents

Publication Publication Date Title
JP6824217B2 (en) Transport controller, method and program
JP5891718B2 (en) robot
CN104786093B (en) The whirling vibration of throw and dynamically balanced adjustment mechanism
JP6895242B2 (en) Robot control device, robot control method and picking device
JP6008816B2 (en) Method and system for controlling operation of an elevator system
JP6484287B2 (en) Damage detection device and damage detection method for linear guide
JP5287462B2 (en) Angular velocity or angle detection method and robot control method
JP2013144325A (en) Robot apparatus, and failure detection method
CN110282562A (en) Elevating fire truck arm support control method, system and elevating fire truck
JP2016049607A (en) Robot device, method of controlling robot device, program, and recording medium
CN106737864A (en) A kind of Method of Calculation of Robotic Movements mechanism
CN110053042A (en) Robot controller
EP2590044B1 (en) Reduced vibration setpoint generator
CN107272589B (en) Machining path arithmetic unit, machining path operation method
JP6454856B2 (en) Posture detection apparatus and posture detection method
JP5899703B2 (en) robot
JP2019166036A5 (en)
JP2016199359A (en) Turning/translating control device for suspended cargo
JP2013107138A (en) Robot and method for controlling robot
JP2008202719A (en) Vibration restraining control input determination method for time deformation system, conveyance system and vibration restraining control input computation program for time deformation system
WO2020158184A1 (en) Conveyance control device, conveyance control method, conveyance control program, learning device, learning method, learning program, and trained model
JP2018167380A (en) Control device
CN208998765U (en) Flat wire test macro
JP2003294575A (en) Controlling method for model supporting device
JP2018173141A (en) Balancer control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200123

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201029

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201104

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20201222

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210112

R150 Certificate of patent or registration of utility model

Ref document number: 6824217

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250