JP2011056591A - Vibration control device and conveyor - Google Patents

Vibration control device and conveyor Download PDF

Info

Publication number
JP2011056591A
JP2011056591A JP2009205603A JP2009205603A JP2011056591A JP 2011056591 A JP2011056591 A JP 2011056591A JP 2009205603 A JP2009205603 A JP 2009205603A JP 2009205603 A JP2009205603 A JP 2009205603A JP 2011056591 A JP2011056591 A JP 2011056591A
Authority
JP
Japan
Prior art keywords
unit
signal
angle sensor
angle
link
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.)
Withdrawn
Application number
JP2009205603A
Other languages
Japanese (ja)
Inventor
Izumi Iida
泉 飯田
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.)
Seiko Epson Corp
Original Assignee
Seiko Epson 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 Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2009205603A priority Critical patent/JP2011056591A/en
Publication of JP2011056591A publication Critical patent/JP2011056591A/en
Withdrawn legal-status Critical Current

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a vibration control device and a conveyor, which quickly and accurately move a link to a desired position, and reduce power consumption while the link is driven at high speed. <P>SOLUTION: The vibration controller includes a moving part 20 movable with respect to a base 10, an actuator 11 for driving the moving part 20, an angle sensor 30 for detecting a rotation angle, an inertia sensor 12 for detecting inertial force, an arithmetic part 13 for transmitting a control signal, a transmission part 14 for transmitting a detection signal of the angle sensor 30, an instruction part 15 for transmitting an instruction signal, and a determination part 16 for determining driving speed of the moving part 20. The arithmetic part 13 generates the control signal based on a low frequency component of the detection signal of the angle sensor 30 and a high frequency component of a detection signal of the inertia sensor 12. The determination part 16 generates a stop signal for stopping at least one of the angle sensor 30 and the transmission part 14 when the driving speed of the moving part 20 is determined to be larger than reference driving speed. <P>COPYRIGHT: (C)2011,JPO&INPIT

Description

本発明は、振動制御装置及び搬送装置に関するものである。   The present invention relates to a vibration control device and a transfer device.

従来、可動リンク構造を有する装置(ICハンドラー等のロボットやプリンター等の搬送装置)においては、可動リンクを素早く、かつ、精度良く所定の位置に移動させることが可能な技術が求められている。一般に、可動リンク構造を有する装置においては、モーター等のアクチュエーターとエンコーダーと呼ばれる分解能の高い角度センサーとを用いることで位置精度が高められている。また、角度センサーによって検出された各リンクの回転角を基にモーターのトルクを制御することで、素早く安定したリンクの移動を実現している。   2. Description of the Related Art Conventionally, in a device having a movable link structure (a robot such as an IC handler or a transport device such as a printer), a technique capable of moving the movable link to a predetermined position quickly and accurately has been demanded. In general, in an apparatus having a movable link structure, positional accuracy is enhanced by using an actuator such as a motor and an angle sensor with high resolution called an encoder. In addition, by controlling the motor torque based on the rotation angle of each link detected by the angle sensor, quick and stable movement of the link is realized.

しかしながら、リンクの動きによって生じる不要な振動が問題となっている。特に、リンクを停止させた後に残る残留振動は、角度センサーだけでは検出、制御ができないため、振動がおさまるまで十分な時間を経過させないと次の作業を行うことができない。   However, unnecessary vibration caused by link movement is a problem. In particular, the residual vibration remaining after the link is stopped cannot be detected or controlled by the angle sensor alone, and therefore, the next operation cannot be performed unless a sufficient time has elapsed until the vibration is stopped.

このような問題点を解決するための技術が検討されており、例えば、特許文献1では、リンクの角速度の積分値のうちカットオフ周波数以上の高周波数成分と、モーターの回転角とトルク伝達機構の減速比との積のうちカットオフ周波数以下の低周波数成分とを合成して制御に用いることで、所望の位置へリンクを素早く、かつ、精度良く移動させることを実現している。   A technique for solving such a problem has been studied. For example, in Patent Document 1, a high frequency component equal to or higher than a cut-off frequency in an integral value of a link angular velocity, a rotation angle of a motor, and a torque transmission mechanism. The link is quickly and accurately moved to a desired position by synthesizing a low frequency component equal to or lower than the cut-off frequency in the product of the reduction ratio and using it for control.

特開2005−242794号公報JP 2005-242794 A

しかしながら、特許文献1では、高精度の角度センサーを常時動作させているため、電力を無駄に消費してしまう場合がある。例えば、リンクの角速度の積分値における高周波数成分と、モーターの回転角と減速比との積における低周波数成分とを合成して制御に用いる方式では、角度センサーの検出信号(モーターの回転角)の高周波数成分(微小変動成分)は用いられていない。カットオフされた角度センサーの検出信号の微小変動成分は、慣性センサーの検出信号(リンクの角速度の積分値における高周波数成分)によって補われることになる。つまり、デジタル化された角度センサーからの信号の高周波数成分は不要であり、そのために消費された電力は無駄となる。   However, in Patent Document 1, since a highly accurate angle sensor is always operated, power may be wasted. For example, in the method used for control by combining the high frequency component in the integral value of the angular velocity of the link and the low frequency component in the product of the motor rotation angle and the reduction ratio, the detection signal of the angle sensor (motor rotation angle) The high frequency component (minor fluctuation component) is not used. The minute fluctuation component of the detection signal of the angle sensor that has been cut off is supplemented by the detection signal of the inertial sensor (high frequency component in the integrated value of the angular velocity of the link). That is, the high frequency component of the signal from the digitized angle sensor is unnecessary, and the power consumed for this purpose is wasted.

ところで、角度センサーからの信号の高周波数成分は常に不要というわけではない。リンクが高速駆動している場合には、角度センサーの検出信号の高周波数成分は慣性センサーの検出信号によって補うことができるが、リンクが停止あるいは低速駆動している場合には、角度センサーの検出信号の低周波数成分が多くなり高周波数成分が有効なものとなる。したがって、リンクの駆動速度に応じて角度センサーの高周波数成分の取り扱いを変える必要がある。   By the way, the high frequency component of the signal from the angle sensor is not always unnecessary. When the link is driven at high speed, the high frequency component of the angle sensor detection signal can be supplemented by the inertial sensor detection signal, but when the link is stopped or driven at low speed, the angle sensor detection The low frequency component of the signal increases and the high frequency component becomes effective. Therefore, it is necessary to change the handling of high-frequency components of the angle sensor in accordance with the link driving speed.

本発明はこのような事情に鑑みてなされたものであって、所望の位置へリンクを素早く、かつ、精度良く移動させるとともに、リンクが高速駆動している場合に消費電力を低減させることが可能な振動制御装置及び搬送装置を提供することを目的とする。   The present invention has been made in view of such circumstances, and can quickly and accurately move a link to a desired position, and can reduce power consumption when the link is driven at high speed. An object of the present invention is to provide a vibration control device and a transport device.

上記の課題を解決するため、本発明の振動制御装置は、基体に対して回転運動可能な移動部と、前記移動部を駆動するアクチュエーターと、前記アクチュエーターの回転角を検出する角度センサーと、前記基体に対する前記移動部の慣性力を検出する慣性センサーと、前記アクチュエーターに制御信号を伝送する演算部と、前記演算部に前記角度センサーの検出信号を伝送する伝送部と、前記演算部に命令信号を伝送する命令部と、前記移動部の駆動速度が基準となる駆動速度よりも大きいか小さいかを判定する判定部と、を有し、前記演算部は、前記角度センサーの検出信号のうちカットオフ周波数以下の低周波数成分と、前記慣性センサーの検出信号のうち前記カットオフ周波数以上の高周波数成分と、に基づいて前記制御信号を生成し、前記判定部は、前記移動部の駆動速度が前記基準となる駆動速度よりも大きいと判定したときに、前記角度センサーと前記伝送部とのうち少なくとも一方を停止させる停止信号を生成することを特徴とする。   In order to solve the above-described problems, a vibration control device of the present invention includes a moving unit that can rotate with respect to a base, an actuator that drives the moving unit, an angle sensor that detects a rotation angle of the actuator, An inertial sensor that detects an inertial force of the moving unit with respect to a base; a calculation unit that transmits a control signal to the actuator; a transmission unit that transmits a detection signal of the angle sensor to the calculation unit; and a command signal to the calculation unit And a determination unit that determines whether the driving speed of the moving unit is larger or smaller than a reference driving speed, and the arithmetic unit cuts out the detection signal of the angle sensor. The control signal is generated based on a low frequency component equal to or lower than an off frequency and a high frequency component equal to or higher than the cutoff frequency among detection signals of the inertial sensor. The determination unit generates a stop signal for stopping at least one of the angle sensor and the transmission unit when it is determined that the driving speed of the moving unit is higher than the reference driving speed. And

本発明の振動制御装置によれば、角度センサーの検出信号のうちカットオフ周波数以下の低周波数成分と、慣性センサーの検出信号のうちカットオフ周波数以上の高周波数成分と、に基づいて制御信号が生成されるので、慣性センサーのバイアスドリフトの影響を除去することができる。このため、所望の位置へリンク(移動部)を素早く、かつ、精度良く移動させることができる。また、判定部がリンクの駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサーと伝送部とのうち少なくとも一方を停止させる停止信号が生成されるので、リンクが高速駆動している場合に消費電力を低減させることが可能となる。したがって、所望の位置へリンクを素早く、かつ、精度良く移動させるとともに、リンクが高速駆動している場合に消費電力を低減させることが可能な振動制御装置が提供できる。   According to the vibration control device of the present invention, the control signal is generated based on the low frequency component below the cutoff frequency in the detection signal of the angle sensor and the high frequency component above the cutoff frequency in the detection signal of the inertial sensor. Therefore, the influence of the bias drift of the inertial sensor can be eliminated. For this reason, a link (moving part) can be moved to a desired position quickly and accurately. In addition, when the determination unit determines that the link driving speed is higher than the reference driving speed, a stop signal is generated to stop at least one of the angle sensor and the transmission unit. In this case, power consumption can be reduced. Therefore, it is possible to provide a vibration control device that can move the link quickly and accurately to a desired position and reduce power consumption when the link is driven at high speed.

また、この振動制御装置においては、前記角度センサーは、第1の分解能を有する第1の角度検出部と、前記第1の分解能よりも分解能が高い第2の分解能を有する第2の角度検出部と、を有し、前記判定部は、前記角度センサーのうち前記第2の角度検出部のみを停止させる第1の停止信号を生成してもよい。   In the vibration control device, the angle sensor includes a first angle detection unit having a first resolution and a second angle detection unit having a second resolution higher than the first resolution. The determination unit may generate a first stop signal that stops only the second angle detection unit of the angle sensor.

この構成によれば、角度センサーが相対的に分解能の低い第1の角度検出部と相対的に分解能の高い第2の角度検出部を有し、判定部がリンクの駆動速度が基準となる駆動速度よりも大きいと判定したときに、2つの角度検出部のうち相対的に分解能の高い第2の角度検出部が停止される。このため、それほど精度の高い角度センサーの検出信号が必要ではない場合には、相対的に分解能の高い第2の角度検出部が停止されることで、2つの角度検出部が常時動作されるよりも消費電力を低減させることが可能となる。   According to this configuration, the angle sensor has the first angle detection unit having a relatively low resolution and the second angle detection unit having a relatively high resolution, and the determination unit drives based on the link driving speed. When it is determined that the speed is greater than the speed, the second angle detection unit having a relatively high resolution among the two angle detection units is stopped. For this reason, when the detection signal of the highly accurate angle sensor is not necessary, the second angle detection unit having a relatively high resolution is stopped, so that the two angle detection units are always operated. As a result, power consumption can be reduced.

また、この振動制御装置においては、前記判定部は、前記角度センサーの検出信号のうちの前記高周波数成分に対応する前記伝送部における下位ビットの伝送信号を停止させる第2の停止信号を生成してもよい。   In the vibration control device, the determination unit generates a second stop signal for stopping the transmission signal of the lower bits in the transmission unit corresponding to the high frequency component of the detection signal of the angle sensor. May be.

この構成によれば、判定部がリンクの駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサーの検出信号のうちの高周波数成分に対応する伝送部における下位ビットの伝送信号が停止される。このため、下位ビットの伝送信号が停止された分だけ消費電力を低減させることが可能となる。   According to this configuration, when the determination unit determines that the link driving speed is higher than the reference driving speed, the transmission signal of the lower bits in the transmission unit corresponding to the high frequency component of the detection signal of the angle sensor Is stopped. For this reason, it becomes possible to reduce power consumption by the amount by which the transmission signal of the lower bits is stopped.

また、この振動制御装置においては、前記判定部は、前記第1の停止信号と前記第2の停止信号とを同時に生成してもよい。   In the vibration control device, the determination unit may simultaneously generate the first stop signal and the second stop signal.

この構成によれば、判定部がリンクの駆動速度が基準となる駆動速度よりも大きいと判定したときに、2つの角度検出部のうち相対的に分解能の高い第2の角度検出部が停止される第1の停止信号と、角度センサーの検出信号のうちの高周波数成分に対応する伝送部における下位ビットの伝送信号が停止される第2の停止信号と、が同時に生成される。このため、消費電力を格段に低減させることが可能となる。   According to this configuration, when the determination unit determines that the link drive speed is higher than the reference drive speed, the second angle detection unit having a relatively high resolution among the two angle detection units is stopped. And a second stop signal for stopping the transmission signal of the lower bits in the transmission unit corresponding to the high frequency component of the detection signal of the angle sensor. For this reason, it becomes possible to reduce power consumption markedly.

また、この振動制御装置においては、前記基準となる駆動速度が前記命令部からの前記命令信号に基づいて設定されてもよい。   In the vibration control device, the reference driving speed may be set based on the command signal from the command unit.

この構成によれば、基準となる駆動速度が命令部からの命令信号(予め入力された実験データにより得られたリンク20の駆動速度の情報から算出された信号)に基づくのでリンクの駆動速度を予測することができる。例えば、リンクの駆動速度が基準となる駆動速度とよりも大きいときは、命令信号に基づいて、角度センサー(それほど精度の高い角度センサーの検出信号が必要ではない場合は第2の角度検出部)と伝送部のうち少なくとも一方を停止させることで消費電力を低減させることが可能となる。   According to this configuration, since the reference driving speed is based on the command signal from the command section (a signal calculated from the information on the driving speed of the link 20 obtained from the experimental data input in advance), the link driving speed is reduced. Can be predicted. For example, when the link driving speed is higher than the reference driving speed, an angle sensor (second angle detecting unit when a highly accurate angle sensor detection signal is not required) based on the command signal. It is possible to reduce power consumption by stopping at least one of the transmission units.

また、この振動制御装置においては、前記基準となる駆動速度が前記慣性センサーの検出信号に基づいて設定されてもよい。   In the vibration control device, the reference driving speed may be set based on a detection signal of the inertial sensor.

この構成によれば、リンクの駆動速度が基準となる駆動速度よりも大きいときは、慣性センサーの検出信号が大きくなるので、その値をもって角度センサー(それほど精度の高い角度センサーの検出信号が必要ではない場合は第2の角度検出部)と伝送部のうち少なくとも一方が停止される。したがって、消費電力を低減させることが可能となる。   According to this configuration, when the link driving speed is higher than the reference driving speed, the detection signal of the inertial sensor becomes large, and therefore the angle sensor (the detection signal of the angle sensor with high accuracy is not necessary with that value). If not, at least one of the second angle detection unit) and the transmission unit is stopped. Therefore, power consumption can be reduced.

また、この振動制御装置においては、前記基準となる駆動速度が前記角度センサーの検出信号に基づいて設定されてもよい。   In the vibration control device, the reference driving speed may be set based on a detection signal of the angle sensor.

この構成によれば、リンクの駆動速度が基準となる駆動速度よりも大きいときは、角度センサーの検出信号の微分値が大きくなるので、その値をもって角度センサー(それほど精度の高い角度センサーの検出信号が必要ではない場合は第2の角度検出部)と伝送部のうち少なくとも一方が停止される。したがって、消費電力を低減させることが可能となる。   According to this configuration, when the link driving speed is higher than the reference driving speed, the differential value of the detection signal of the angle sensor becomes large. Is not necessary, at least one of the second angle detection unit) and the transmission unit is stopped. Therefore, power consumption can be reduced.

本発明の搬送装置は、前述した本発明の振動制御装置を備えていることを特徴とする。   The conveyance device of the present invention is characterized by including the above-described vibration control device of the present invention.

この構成によれば、上述した振動制御装置を備えているため、所望の位置へリンクを素早く、かつ、精度良く移動させるとともに、リンクが高速駆動している場合に消費電力を低減させることが可能な提供できる。   According to this configuration, since the vibration control device described above is provided, the link can be quickly and accurately moved to a desired position, and power consumption can be reduced when the link is driven at high speed. Can provide.

本発明に係る振動制御装置を模式的に示す図である。It is a figure which shows typically the vibration control apparatus which concerns on this invention. 演算部の演算方法を説明するブロック図である。It is a block diagram explaining the calculation method of a calculating part. 第1の角度検出部と第2の角度検出部を有する角度センサーを示す図である。It is a figure which shows the angle sensor which has a 1st angle detection part and a 2nd angle detection part. 伝送信号の停止部分を説明する図である。It is a figure explaining the stop part of a transmission signal. 伝送部の模式回路図である。It is a schematic circuit diagram of a transmission part. 命令部の命令信号を説明するブロック図である。It is a block diagram explaining the command signal of a command part. 慣性センサーまたは角度センサーの検出信号を説明するブロック図である。It is a block diagram explaining the detection signal of an inertial sensor or an angle sensor. 搬送装置としてのXYステージ装置を示す図である。It is a figure which shows the XY stage apparatus as a conveying apparatus. 搬送装置としてのレーザープリンターを示す図である。It is a figure which shows the laser printer as a conveying apparatus. 搬送装置としてのインクジェットプリンターを示す図である。It is a figure which shows the inkjet printer as a conveying apparatus.

以下、図面を参照して、本発明の実施の形態について説明する。かかる実施の形態は、本発明の一態様を示すものであり、この発明を限定するものではなく、本発明の技術的思想の範囲内で任意に変更可能である。また、以下の図面においては、各構成をわかりやすくするために、実際の構造と各構造における縮尺や数等が異なっている。   Embodiments of the present invention will be described below with reference to the drawings. This embodiment shows one aspect of the present invention, and does not limit the present invention, and can be arbitrarily changed within the scope of the technical idea of the present invention. Moreover, in the following drawings, in order to make each structure easy to understand, an actual structure and a scale, a number, and the like in each structure are different.

(第1実施形態)
図1は、本発明の第1実施形態における振動制御装置1の概略構成図である。図1に示すように、振動制御装置1は、基体10と、リンク(移動部)20と、サーボモーター等のアクチュエーター11と、エンコーダー等の角度センサー30と、慣性センサー12と、演算部13と、伝送部14と、命令部15と、判定部16と、を有して構成されている。
(First embodiment)
FIG. 1 is a schematic configuration diagram of a vibration control device 1 according to the first embodiment of the present invention. As shown in FIG. 1, the vibration control device 1 includes a base body 10, a link (moving unit) 20, an actuator 11 such as a servo motor, an angle sensor 30 such as an encoder, an inertial sensor 12, and a calculation unit 13. , A transmission unit 14, a command unit 15, and a determination unit 16.

基体10の上部には角度センサー30及びアクチュエーター11を介してリンク20が取り付けられている。リンク20は、基体10対して回転運動可能になっている。リンク20は、リンク本体21と、リンク本体21の先端に設けられ鉛直方向に移動可能なスライド軸22と、スライド軸22の端部に設けられたハンド23と、を有している。   A link 20 is attached to the upper part of the base body 10 via an angle sensor 30 and an actuator 11. The link 20 can rotate with respect to the base 10. The link 20 includes a link main body 21, a slide shaft 22 provided at the tip of the link main body 21 and movable in the vertical direction, and a hand 23 provided at an end of the slide shaft 22.

アクチュエーター11は基体10の頂部に設けられ、その側部にはリンク20が取り付けられている。アクチュエーター11は、リンク20を駆動するものである。   The actuator 11 is provided on the top of the base 10 and a link 20 is attached to the side thereof. The actuator 11 drives the link 20.

角度センサー30は、アクチュエーター11の下部に設けられている。角度センサー30は、アクチュエーター11の回転角を検出する機能を有する。   The angle sensor 30 is provided below the actuator 11. The angle sensor 30 has a function of detecting the rotation angle of the actuator 11.

慣性センサー12は、ハンド23に近いスライド軸22に取り付けられている。慣性センサー12としては、例えばレートジャイロ等の角速度センサーが用いられる。慣性センサー12は、基体10に対するリンク20の慣性力(角速度)を検出する機能を有する。なお、基体10に対するリンク20の角速度は、リンク20の回転面内の角速度成分である。   The inertial sensor 12 is attached to a slide shaft 22 near the hand 23. As the inertia sensor 12, for example, an angular velocity sensor such as a rate gyro is used. The inertial sensor 12 has a function of detecting the inertial force (angular velocity) of the link 20 with respect to the base body 10. Note that the angular velocity of the link 20 with respect to the base 10 is an angular velocity component in the rotation plane of the link 20.

演算部13は、アクチュエーター11と、慣性センサー12と、伝送部14と、命令部15と、に電気的に接続されている。演算部13は、アクチュエーター11に制御信号を伝送する機能を有する。また、演算部13には命令部15により命令信号が伝送される。   The calculation unit 13 is electrically connected to the actuator 11, the inertial sensor 12, the transmission unit 14, and the command unit 15. The calculation unit 13 has a function of transmitting a control signal to the actuator 11. A command signal is transmitted to the calculation unit 13 by the command unit 15.

図2は、演算部13の演算方法を説明するブロック図である。先ず、角度センサー30によってアクチュエーター11の回転角が検出される。次に、伝送部14によって角度センサー30で検出されたアクチュエーター11の回転角(角度センサー30の検出信号)が演算部13に伝送される。次に、角度センサー30の検出信号がローパスフィルタLPFに通過される。これにより、角度センサー30の検出信号のうちカットオフ周波数以下の低周波数成分が得られる。   FIG. 2 is a block diagram illustrating a calculation method of the calculation unit 13. First, the rotation angle of the actuator 11 is detected by the angle sensor 30. Next, the rotation angle of the actuator 11 (detection signal of the angle sensor 30) detected by the angle sensor 30 by the transmission unit 14 is transmitted to the calculation unit 13. Next, the detection signal of the angle sensor 30 is passed through the low pass filter LPF. Thereby, the low frequency component below the cut-off frequency among the detection signals of the angle sensor 30 is obtained.

一方、慣性センサー12によって基体10に対するリンク20の角速度が検出される。次に、慣性センサー12で検出されたリンク20の角速度(慣性センサー12の検出信号)が演算部13に伝送される。次に、演算部13によってリンク20の角速度が積分される。次に、この積分結果がハイパスフィルタHPFに通過される。これにより、リンク20の角度のうちカットオフ周波数以上の高周波数成分が得られる。ここで、リンク20の角度のうち低周波数成分を除去する理由は、リンク20の角速度の積分ではバイアスドリフトの影響によりリンク20の角度を正確に求めることができないので、このバイアスドリフトの影響を除去するためである。   On the other hand, the angular velocity of the link 20 relative to the base body 10 is detected by the inertial sensor 12. Next, the angular velocity (detection signal of the inertial sensor 12) of the link 20 detected by the inertial sensor 12 is transmitted to the calculation unit 13. Next, the angular velocity of the link 20 is integrated by the calculation unit 13. Next, this integration result is passed through the high-pass filter HPF. Thereby, the high frequency component more than a cut-off frequency is obtained among the angles of the link 20. FIG. Here, the reason for removing the low-frequency component from the angle of the link 20 is that the angle of the link 20 cannot be obtained accurately due to the influence of the bias drift by the integration of the angular velocity of the link 20, so the influence of the bias drift is removed. It is to do.

このように、ローパスフィルタLPF及びハイパスフィルタHPFを用いることによって、角度センサー30の検出信号の低周波数成分と、慣性センサー12の検出信号の積分結果の高周波数成分と、を加算することができる。この演算によって、基体10に対するリンク20の角度が算出され、制御信号が生成される。そして、演算部13によって、アクチュエーター11に制御信号が伝送される。   Thus, by using the low-pass filter LPF and the high-pass filter HPF, the low-frequency component of the detection signal of the angle sensor 30 and the high-frequency component of the integration result of the detection signal of the inertial sensor 12 can be added. By this calculation, the angle of the link 20 with respect to the base body 10 is calculated, and a control signal is generated. Then, a control signal is transmitted to the actuator 11 by the arithmetic unit 13.

判定部16は、角度センサー30と、伝送部14と、に電気的に接続されている。判定部16は、リンク20の駆動速度が基準となる駆動速度よりも大きいか小さいかを判定する。なお、判定部16の判定基準(基準となる駆動速度)については後述する。   The determination unit 16 is electrically connected to the angle sensor 30 and the transmission unit 14. The determination unit 16 determines whether the drive speed of the link 20 is larger or smaller than the reference drive speed. Note that the determination standard (standard drive speed) of the determination unit 16 will be described later.

また、判定部16は、リンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号を生成する。これにより、リンクが高速駆動している場合に電力を無駄に消費することがなくなり、消費電力を低減させることが可能となる。   Moreover, the determination part 16 produces | generates the stop signal which stops at least one of the angle sensor 30 and the transmission part 14, when it determines with the drive speed of the link 20 being larger than the drive speed used as a reference | standard. As a result, power is not wasted when the link is driven at high speed, and power consumption can be reduced.

図3は、第1の角度検出部31と第2の角度検出部32を有する角度センサー30を示す図である。図3において、符号41はLED、符号42はコリメートレンズ、符号43はフォトセンサー(PDアレイ)、符号44は磁気センサー(MRセンサー)、符号45は磁石である。   FIG. 3 is a diagram illustrating an angle sensor 30 having a first angle detection unit 31 and a second angle detection unit 32. In FIG. 3, reference numeral 41 denotes an LED, reference numeral 42 denotes a collimating lens, reference numeral 43 denotes a photosensor (PD array), reference numeral 44 denotes a magnetic sensor (MR sensor), and reference numeral 45 denotes a magnet.

図3に示すように、LED41から射出された光は、コリメートレンズ42、角度センサー30を介してフォトセンサー43に入射する。このとき、角度センサー30はモーター(図示略)によって回転する。   As shown in FIG. 3, the light emitted from the LED 41 enters the photo sensor 43 via the collimating lens 42 and the angle sensor 30. At this time, the angle sensor 30 is rotated by a motor (not shown).

角度センサー30は第1の分解能を有する第1の角度検出部31と、第1の分解能よりも分解能が高い第2の分解能を有する第2の角度検出部32と、を有している。第1の角度検出部31としては、例えばABSパターンを有するもの(例えば11001111001パターン)を用いることができる。第2の角度検出部32としては、例えばINCパターンを有するもの(例えば1010101010パターン)を用いることができる。   The angle sensor 30 includes a first angle detection unit 31 having a first resolution and a second angle detection unit 32 having a second resolution that is higher than the first resolution. As the 1st angle detection part 31, what has an ABS pattern (for example, 11001111001 pattern) can be used, for example. As the 2nd angle detection part 32, what has an INC pattern (for example, 10101010110 pattern) can be used, for example.

第1の角度検出部31のABS検出は第2の角度検出部32のINC検出に比べて分解能が高くないので、それほど精度の高い角度センサー30の検出信号(アクチュエーター11の回転角)が必要ではない場合に有効である。   Since the ABS detection of the first angle detection unit 31 does not have a higher resolution than the INC detection of the second angle detection unit 32, a highly accurate detection signal of the angle sensor 30 (rotation angle of the actuator 11) is not necessary. It is effective when there is not.

本実施形態では、判定部16は、リンク20の駆動速度が基準となる速度よりも大きいと判定したときに、角度センサー30のうち第2の角度検出部32のみを停止させる第1の停止信号を生成する。つまり、それほど精度の高い角度センサー30の検出信号が必要ではない場合には、相対的に分解能の高い第2の角度検出部32を停止させることができる。これにより、2つの角度検出部31,32が常時動作されるよりも消費電力を低減させることが可能となる。   In the present embodiment, when the determination unit 16 determines that the drive speed of the link 20 is greater than the reference speed, the first stop signal that stops only the second angle detection unit 32 of the angle sensor 30. Is generated. That is, when the detection signal of the angle sensor 30 with high accuracy is not necessary, the second angle detection unit 32 with relatively high resolution can be stopped. Thereby, it becomes possible to reduce power consumption rather than the two angle detection parts 31 and 32 being always operated.

図4は、伝送信号の停止部分を説明する図である。図4(a)は通常時の伝送信号、図(b)はビット数低減時の状態を示している。図5は、伝送部14の模式回路図である。   FIG. 4 is a diagram for explaining a stop portion of the transmission signal. FIG. 4A shows a transmission signal in a normal state, and FIG. 4B shows a state when the number of bits is reduced. FIG. 5 is a schematic circuit diagram of the transmission unit 14.

図4(a)に示すように、伝送信号はヘッダーとデータ本体とパリティーとからなっている。伝送信号(ヘッダー、データ本体、パリティー)に対応するイネーブルはON状態になっている。また、伝送信号(ヘッダー、データ本体、パリティー)に対応しないイネーブルはOFF状態になっている。   As shown in FIG. 4A, the transmission signal includes a header, a data body, and a parity. The enable corresponding to the transmission signal (header, data body, parity) is in the ON state. In addition, an enable that does not correspond to a transmission signal (header, data body, parity) is in an OFF state.

ところで、ロボット用エンコーダーの検出信号(角度センサー30の検出信号)を伝送する際には、数mの長さの伝送路(ケーブル)を用いて伝送するためRS−485規格を使うことが多い。一般に、伝送損失や外部ノイズに備えるため数ボルト以上の差動電圧が伝送されている。例えば5Vで50Ω終端の差動伝送の場合、この伝送路だけで0.5ワットの電力を消費する。また、6軸ロボットの場合、各軸アクチュエーターの回転角を検出する角度センサー30の検出信号を伝送するに当たっては3ワットの電力を消費する。   By the way, when transmitting the detection signal of the robot encoder (detection signal of the angle sensor 30), the RS-485 standard is often used for transmission using a transmission path (cable) having a length of several meters. Generally, a differential voltage of several volts or more is transmitted to prepare for transmission loss and external noise. For example, in the case of differential transmission with 50 V termination at 5 V, 0.5 watts of power is consumed only by this transmission line. In the case of a 6-axis robot, 3 watts of power is consumed to transmit the detection signal of the angle sensor 30 that detects the rotation angle of each axis actuator.

そこで、本実施形態では、判定部16は、リンク20の駆動速度が基準となる速度よりも大きいと判定したときに、角度センサー30の検出信号のうちの高周波数成分に対応する伝送部14における下位ビットの伝送信号を停止させる第2の停止信号を生成する。つまり、角度センサー30の検出信号のうちデータ本体の一部(下位ビット)のビット数を減らす。さらに、角度センサー30の検出信号を伝送していないときには差動バッファをハイインピーダンス状態(図5に示す回路図の中で大きな抵抗値を示す部分)にする。これにより、下位ビットのビット数を減らした分だけ終端抵抗における消費電力を低減させることができる。   Therefore, in the present embodiment, when the determination unit 16 determines that the driving speed of the link 20 is larger than the reference speed, the transmission unit 14 corresponding to the high frequency component of the detection signal of the angle sensor 30 is used. A second stop signal for stopping the transmission signal of the lower bits is generated. That is, the number of bits of a part (lower order bits) of the data body in the detection signal of the angle sensor 30 is reduced. Further, when the detection signal of the angle sensor 30 is not transmitted, the differential buffer is set in a high impedance state (a portion showing a large resistance value in the circuit diagram shown in FIG. 5). As a result, the power consumption in the termination resistor can be reduced by the amount corresponding to the reduced number of lower bits.

図6は、命令部15の命令信号を説明するブロック図である。図6に示すように、本実施形態では、判定部16の判定基準(基準となる駆動速度)が命令部15からの命令信号に基づいて設定される。   FIG. 6 is a block diagram illustrating the command signal of the command unit 15. As shown in FIG. 6, in this embodiment, the determination reference (drive speed as a reference) of the determination unit 16 is set based on a command signal from the command unit 15.

例えば、命令部15には、予め実験データにより得られたリンク20の駆動速度の情報が蓄積されており、これらの情報に基づいて判定部16に命令信号が伝送される。判定部16は命令部15からの命令信号とリンク20の駆動速度とに基づいて、リンク20の駆動速度が基準となる駆動速度よりも大きいか小さいかを判定する。そして、判定部16は、リンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号を生成する。この停止信号は、判定部16から出力され、角度センサー30と伝送部14とのうち少なくとも一方に伝送される。これにより、角度センサー30(それほど精度の高い角度センサー30の検出信号が必要ではない場合は第2の角度検出部32)と伝送部のうち少なくとも一方を停止させることで消費電力を低減させることが可能となる。   For example, information on the driving speed of the link 20 obtained in advance from experimental data is stored in the command unit 15, and a command signal is transmitted to the determination unit 16 based on these information. Based on the command signal from the command unit 15 and the drive speed of the link 20, the determination unit 16 determines whether the drive speed of the link 20 is larger or smaller than the reference drive speed. When the determination unit 16 determines that the drive speed of the link 20 is greater than the reference drive speed, the determination unit 16 generates a stop signal that stops at least one of the angle sensor 30 and the transmission unit 14. The stop signal is output from the determination unit 16 and transmitted to at least one of the angle sensor 30 and the transmission unit 14. Accordingly, power consumption can be reduced by stopping at least one of the angle sensor 30 (the second angle detection unit 32 when the detection signal of the angle sensor 30 with high accuracy is not necessary) and the transmission unit. It becomes possible.

本発明の振動制御装置1によれば、角度センサー30の検出信号のうちカットオフ周波数以下の低周波数成分と、慣性センサー12の検出信号のうちカットオフ周波数以上の高周波数成分と、に基づいて制御信号が生成されるので、慣性センサー12のバイアスドリフトの影響を除去することができる。このため、所望の位置へリンク20を素早く、かつ、精度良く移動させることができる。また、判定部16がリンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号が生成されるので、リンク20が高速駆動している場合に消費電力を低減させることが可能となる。したがって、所望の位置へリンク20を素早く、かつ、精度良く移動させるとともに、リンク20が高速駆動している場合に消費電力を低減させることが可能な振動制御装置1が提供できる。   According to the vibration control device 1 of the present invention, based on the low frequency component below the cutoff frequency in the detection signal of the angle sensor 30 and the high frequency component above the cutoff frequency in the detection signal of the inertial sensor 12. Since the control signal is generated, the influence of the bias drift of the inertial sensor 12 can be removed. For this reason, the link 20 can be quickly and accurately moved to a desired position. Further, when the determination unit 16 determines that the drive speed of the link 20 is higher than the reference drive speed, a stop signal that stops at least one of the angle sensor 30 and the transmission unit 14 is generated. It is possible to reduce power consumption when 20 is driven at high speed. Therefore, it is possible to provide the vibration control device 1 that can move the link 20 quickly and accurately to a desired position and can reduce power consumption when the link 20 is driven at high speed.

また、この構成によれば、角度センサー30が相対的に分解能の低い第1の角度検出部31と相対的に分解能の高い第2の角度検出部32を有し、判定部16がリンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、2つの角度検出部31,32のうち相対的に分解能の高い第2の角度検出部32が停止される。このため、それほど精度の高い角度センサーの検出信号が必要ではない場合には、相対的に分解能の高い第2の角度検出部32が停止されることで、2つの角度検出部31,32が常時動作されるよりも消費電力を低減させることが可能となる。   Further, according to this configuration, the angle sensor 30 includes the first angle detection unit 31 having a relatively low resolution and the second angle detection unit 32 having a relatively high resolution, and the determination unit 16 includes the link 20. When it is determined that the driving speed is higher than the reference driving speed, the second angle detecting unit 32 having a relatively high resolution among the two angle detecting units 31 and 32 is stopped. For this reason, when the detection signal of the highly accurate angle sensor is not necessary, the second angle detection unit 32 having a relatively high resolution is stopped, so that the two angle detection units 31 and 32 are always in the state. It becomes possible to reduce power consumption rather than being operated.

また、この構成によれば、判定部16がリンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、角度センサー30の検出信号のうちの高周波数成分に対応する伝送部における下位ビットの伝送信号が停止される。このため、下位ビットの伝送信号が停止された分だけ消費電力を低減させることが可能となる。   Further, according to this configuration, when the determination unit 16 determines that the drive speed of the link 20 is larger than the reference drive speed, the transmission unit corresponding to the high frequency component of the detection signal of the angle sensor 30 The lower bit transmission signal is stopped. For this reason, it becomes possible to reduce power consumption by the amount by which the transmission signal of the lower bits is stopped.

また、この構成によれば、基準となる駆動速度が命令部15からの命令信号(予め入力された実験データにより得られたリンク20の駆動速度の情報から算出された信号)に基づくのでリンク20の駆動速度を予測することができる。例えば、リンク20の駆動速度が基準となる駆動速度とよりも大きいときは、命令信号に基づいて、角度センサー30(それほど精度の高い角度センサーの検出信号が必要ではない場合は第2の角度検出部32)と伝送部14のうち少なくとも一方を停止させることで消費電力を低減させることが可能となる。   Further, according to this configuration, since the reference driving speed is based on the command signal from the command unit 15 (a signal calculated from the driving speed information of the link 20 obtained from the experimental data input in advance), the link 20 Can be predicted. For example, when the drive speed of the link 20 is higher than the reference drive speed, the angle sensor 30 (the second angle detection when a highly accurate detection signal of the angle sensor is not required) based on the command signal. It is possible to reduce power consumption by stopping at least one of the unit 32) and the transmission unit 14.

なお、本実施形態において、判定部16が第1の停止信号と第2の停止信号とを同時に生成してもよい。この構成によれば、判定部16がリンク20の駆動速度が基準となる駆動速度よりも大きいと判定したときに、2つの角度検出部31,32のうち相対的に分解能の高い第2の角度検出部32が停止される第1の停止信号と、角度センサー30の検出信号のうちの高周波数成分に対応する伝送部14における下位ビットの伝送信号が停止される第2の停止信号と、が同時に生成される。このため、消費電力を格段に低減させることが可能となる。   In the present embodiment, the determination unit 16 may generate the first stop signal and the second stop signal at the same time. According to this configuration, when the determination unit 16 determines that the drive speed of the link 20 is higher than the reference drive speed, the second angle having a relatively high resolution among the two angle detection units 31 and 32. The first stop signal for stopping the detection unit 32 and the second stop signal for stopping the transmission signal of the lower bits in the transmission unit 14 corresponding to the high frequency component of the detection signal of the angle sensor 30 Generated at the same time. For this reason, it becomes possible to reduce power consumption markedly.

また、判定部16が角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号を生成しているが、これに限らない。例えば、命令部15が角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号を生成する機能を有していてもよい。すなわち、判定部16とは別個に角度センサー30と伝送部14とのうち少なくとも一方を停止させる停止信号を生成する機能を有する装置が設けられていてもよい。   Moreover, although the determination part 16 has produced | generated the stop signal which stops at least one of the angle sensor 30 and the transmission part 14, it does not restrict to this. For example, the command unit 15 may have a function of generating a stop signal that stops at least one of the angle sensor 30 and the transmission unit 14. That is, a device having a function of generating a stop signal for stopping at least one of the angle sensor 30 and the transmission unit 14 may be provided separately from the determination unit 16.

(第2実施形態)
図7は、本発明の第2実施形態に係る慣性センサー12または角度センサー30の検出信号を説明するブロック図である。図7は、図6に対応した、第2実施形態に係る判定部16の停止信号生成工程を示した図である。図7に示すように、本実施形態の停止信号生成工程は慣性センサー12(角度センサー30)の検出信号に基づいて基準となる駆動速度が設定される点で、上述の第1実施形態で説明した停止信号生成工程と異なっている。その他の点は第1実施形態と同様であるので、図6と同様の要素には同一の符号を付し、詳細な説明は省略する。
(Second Embodiment)
FIG. 7 is a block diagram illustrating a detection signal of the inertial sensor 12 or the angle sensor 30 according to the second embodiment of the present invention. FIG. 7 is a diagram illustrating a stop signal generation process of the determination unit 16 according to the second embodiment, corresponding to FIG. As shown in FIG. 7, the stop signal generation process of this embodiment is described in the first embodiment described above in that a reference driving speed is set based on the detection signal of the inertial sensor 12 (angle sensor 30). This is different from the stop signal generation process. Since the other points are the same as in the first embodiment, the same elements as those in FIG. 6 are denoted by the same reference numerals, and detailed description thereof is omitted.

図7に示すように、本実施形態では、判定部16の判定基準(基準となる駆動速度)が慣性センサー12の出力信号に基づいて設定される。例えば、判定部16には予め判定基準となるしきい値が入力されており、このしきい値に基づいて基準となる駆動速度が決定される。判定部16において、慣性センサー12の検出信号としきい値とが比較される。リンク20の駆動速度が基準となる駆動速度よりも大きいときは、慣性センサー12の出力信号(リンク20の角速度)が大きくなるので、その値をもって角度センサー30(それほど精度の高い角度センサーの検出信号が必要ではない場合は第2の角度検出部32)と伝送部14のうち少なくとも一方が停止される。したがって、消費電力を低減させることが可能となる。   As shown in FIG. 7, in this embodiment, the determination reference (drive speed as a reference) of the determination unit 16 is set based on the output signal of the inertial sensor 12. For example, a threshold value serving as a determination criterion is input to the determination unit 16 in advance, and a reference driving speed is determined based on this threshold value. In the determination unit 16, the detection signal of the inertial sensor 12 is compared with the threshold value. When the drive speed of the link 20 is higher than the reference drive speed, the output signal of the inertial sensor 12 (the angular speed of the link 20) becomes large, and therefore the angle sensor 30 (the detection signal of the angle sensor with a very high accuracy) with that value. Is not necessary, at least one of the second angle detector 32) and the transmitter 14 is stopped. Therefore, power consumption can be reduced.

なお、判定部16の判定基準(基準となる駆動速度)が角度センサー30の出力信号に基づいて設定されても、同様な効果が得られる。また、角度センサー30と伝送部14とのうち少なくとも一方を停止させるときには角度センサー30を用い、稼動させるときには慣性センサー12を用いる組み合わせにより設定されてもよい。   Note that the same effect can be obtained even if the determination reference (reference drive speed) of the determination unit 16 is set based on the output signal of the angle sensor 30. Alternatively, the angle sensor 30 may be set by a combination using the angle sensor 30 when stopping at least one of the angle sensor 30 and the transmission unit 14 and using the inertial sensor 12 when operating.

(搬送装置)
図8は、本発明の振動制御装置を用いた搬送装置の一例であるXYステージ装置(液滴吐出装置)を示す図である。図8に示すように、液滴吐出装置100は、液滴吐出ヘッド101と、駆動軸104と、ガイド軸105と、ステージ107と、クリーニング機構108と、基台109、ヒーター106と、上述した本発明の駆動制御装置を用いたコントローラーCTと、を備えている。なお、コントローラーCTにおける慣性センサーとしては、例えば加速度センサーが用いられる。コントローラーCTにおける慣性センサーは、液滴吐出ヘッド101のY軸方向の慣性力(加速度)、ステージ107あるいはクリーニング機構108のX軸方向の慣性力(加速度)、を検出する機能を有する。
(Transport device)
FIG. 8 is a diagram showing an XY stage device (droplet discharge device) which is an example of a transport device using the vibration control device of the present invention. As shown in FIG. 8, the droplet discharge device 100 includes a droplet discharge head 101, a drive shaft 104, a guide shaft 105, a stage 107, a cleaning mechanism 108, a base 109, a heater 106, and the above-described components. And a controller CT using the drive control device of the present invention. For example, an acceleration sensor is used as the inertial sensor in the controller CT. The inertial sensor in the controller CT has a function of detecting an inertial force (acceleration) in the Y-axis direction of the droplet discharge head 101 and an inertial force (acceleration) in the X-axis direction of the stage 107 or the cleaning mechanism 108.

液滴吐出ヘッド101のノズル開口部からは、ステージ107に支持されている基板100Pに対して機能液が吐出される。駆動軸104には駆動モーター102が接続されている。駆動モーター102は例えばステッピングモーターであり、コントローラーCTからY軸方向の駆動信号が供給されると、駆動軸104を回転させる。駆動軸104が回転すると、液滴吐出ヘッド101はY軸方向に移動する。ガイド軸105は、基台109に対して動かないように固定されている。ステージ107は、駆動モーター103を備えている。駆動モーター103は例えばステッピングモーターであり、コントローラーCTからX軸方向の駆動信号が供給されると、ステージ107をX軸方向に移動させる。   From the nozzle opening of the droplet discharge head 101, the functional liquid is discharged onto the substrate 100P supported by the stage 107. A drive motor 102 is connected to the drive shaft 104. The drive motor 102 is a stepping motor, for example, and rotates the drive shaft 104 when a drive signal in the Y-axis direction is supplied from the controller CT. When the drive shaft 104 rotates, the droplet discharge head 101 moves in the Y-axis direction. The guide shaft 105 is fixed so as not to move with respect to the base 109. The stage 107 includes a drive motor 103. The drive motor 103 is a stepping motor, for example, and moves the stage 107 in the X-axis direction when a drive signal in the X-axis direction is supplied from the controller CT.

コントローラーCTは、液滴吐出ヘッド101に液滴の吐出用制御用の電圧を供給する。また、コントローラーCTは、駆動モーター102に対して液滴吐出ヘッド101のY軸方向への移動を制御するパルス信号を供給するとともに、駆動モーター103に対してステージ107のX軸方向への移動を制御する駆動パルス信号を供給する。   The controller CT supplies a droplet discharge control voltage to the droplet discharge head 101. The controller CT supplies a pulse signal for controlling the movement of the droplet discharge head 101 in the Y-axis direction to the drive motor 102 and moves the stage 107 in the X-axis direction to the drive motor 103. A drive pulse signal to be controlled is supplied.

クリーニング機構108は、液滴吐出ヘッド101をクリーニングするものであって、駆動モーター(図示略)を備えている。この駆動モーターの制御により、クリーニング機構108はガイド軸105に沿ってX軸方向に移動する。クリーニング機構108の移動についてもコントローラーCTによって制御される。ヒーター106は例えばランプアニールにより基板100Pを熱処理する手段であり、基板100P上に塗布された機能液に含まれる溶媒の蒸発及び乾燥を行う。このヒーター106の電源の投入及び遮断についてもコントローラーCTによって制御される。   The cleaning mechanism 108 is for cleaning the droplet discharge head 101 and includes a drive motor (not shown). The cleaning mechanism 108 moves in the X-axis direction along the guide shaft 105 by the control of the drive motor. The movement of the cleaning mechanism 108 is also controlled by the controller CT. The heater 106 is means for heat-treating the substrate 100P by, for example, lamp annealing, and evaporates and dries the solvent contained in the functional liquid applied on the substrate 100P. The heater CT is also turned on and off by the controller CT.

そして、液滴吐出装置100は、液滴吐出ヘッド101と基板100Pを支持するステージ107とを相対的に走査しつつ基板100Pに対して液滴を吐出する。この構成によれば、上述した振動制御装置(コントローラーCT)を備えているため、所望の位置へ液滴吐出ヘッド101(ステージ107)を素早く、かつ、精度良く移動させるとともに、液滴吐出ヘッド101(ステージ107)が高速駆動している場合に消費電力を低減させることが可能な液滴吐出装置100が提供できる。   The droplet discharge device 100 discharges droplets onto the substrate 100P while relatively scanning the droplet discharge head 101 and the stage 107 that supports the substrate 100P. According to this configuration, since the above-described vibration control device (controller CT) is provided, the droplet discharge head 101 (stage 107) can be quickly and accurately moved to a desired position, and the droplet discharge head 101 can be moved. It is possible to provide the droplet discharge device 100 capable of reducing power consumption when the (stage 107) is driven at high speed.

図9は、本発明の振動制御装置を用いた搬送装置の一例である印刷装置(レーザープリンター)を示す図である。図9に示すように、レーザープリンター200は、モーター220と、動力伝達機構221と、感光ドラム222と、帯電装置225と、潜像形成手段226と、現像装置227と、転写装置229と、定着装置230と、上述した本発明の駆動制御装置を用いたコントローラー240と、を備えている。   FIG. 9 is a diagram showing a printing apparatus (laser printer) which is an example of a transport apparatus using the vibration control apparatus of the present invention. As shown in FIG. 9, the laser printer 200 includes a motor 220, a power transmission mechanism 221, a photosensitive drum 222, a charging device 225, a latent image forming unit 226, a developing device 227, a transfer device 229, and a fixing device. The apparatus 230 and the controller 240 using the drive control apparatus of this invention mentioned above are provided.

モーター220は、動力伝達機構221を介して感光ドラム222に連結されている。モーター220は、コントローラー240からの制御信号により感光ドラム222を矢印D方向に回転させる。感光ドラム222の周辺には帯電装置225が配置されている。帯電装置225により、感光ドラム222の表面が所定の極性に帯電される。すると、潜像形成手段226から感光ドラム222の帯電面にレーザー光の走査による画像露光が行われ、感光ドラム222の表面に画像データの階調情報に基づく静電潜像が形成される。このようにして形成された静電潜像は、現像装置227から搬送されたトナー228が感光ドラム222の表面に付着して画像として顕在化する。そして、転写装置229により感光ドラム222上の画像が記録紙200Pに転写される。記録紙200Pに転写された画像は定着装置230によって定着される。   The motor 220 is connected to the photosensitive drum 222 via a power transmission mechanism 221. The motor 220 rotates the photosensitive drum 222 in the arrow D direction according to a control signal from the controller 240. A charging device 225 is disposed around the photosensitive drum 222. The surface of the photosensitive drum 222 is charged with a predetermined polarity by the charging device 225. Then, the latent image forming unit 226 performs image exposure on the charged surface of the photosensitive drum 222 by scanning with laser light, and an electrostatic latent image based on the gradation information of the image data is formed on the surface of the photosensitive drum 222. The electrostatic latent image formed in this manner is manifested as an image as the toner 228 conveyed from the developing device 227 adheres to the surface of the photosensitive drum 222. Then, the image on the photosensitive drum 222 is transferred to the recording paper 200P by the transfer device 229. The image transferred to the recording paper 200P is fixed by the fixing device 230.

この構成によれば、上述した振動制御装置(コントローラー240)を備えているため、感光ドラム222を素早く、かつ、精度良く回転させるとともに、感光ドラム222が高速駆動している場合に消費電力を低減させることが可能なレーザープリンター200が提供できる。   According to this configuration, since the vibration control device (controller 240) described above is provided, the photosensitive drum 222 is rotated quickly and accurately, and power consumption is reduced when the photosensitive drum 222 is driven at high speed. The laser printer 200 that can be provided can be provided.

図10は、本発明の振動制御装置を用いた搬送装置の一例である印刷装置(インクジェットプリンター)を示す図である。図10に示すように、インクジェットプリンター300は、筐体340と、ガイドレール341と、動力伝達機構342と、キャリッジ343と、上述した本発明の駆動制御装置を用いたコントローラー350と、を備えている。なお、コントローラー350における慣性センサーとしては、例えば加速度センサーが用いられる。コントローラー350における慣性センサーは、キャリッジ343の矢印E方向の慣性力(加速度)を検出する機能を有する。   FIG. 10 is a diagram illustrating a printing apparatus (inkjet printer) which is an example of a transport apparatus using the vibration control apparatus of the present invention. As shown in FIG. 10, the inkjet printer 300 includes a housing 340, a guide rail 341, a power transmission mechanism 342, a carriage 343, and a controller 350 using the above-described drive control device of the present invention. Yes. As the inertial sensor in the controller 350, for example, an acceleration sensor is used. The inertial sensor in the controller 350 has a function of detecting an inertial force (acceleration) in the direction of arrow E of the carriage 343.

インクジェットプリンター300は、モーター(図示略)に連結された動力伝達機構342により、コントローラー350からの制御信号に基づいて、ガイドレール341に懸架されたキャリッジ343が矢印E方向に移動可能に構成されている。キャリッジ343にはインクジェットヘッドが備えられており、コントローラー350からの制御信号に基づいて、インクジェットヘッドを矢印E方向に移動させながら液滴が記録紙300Pに吐出される。そして、記録紙300Pが矢印F方向に順次搬送されることで画像が記録紙300Pに印刷される。   The ink jet printer 300 is configured such that a carriage 343 suspended on a guide rail 341 is movable in the direction of arrow E based on a control signal from a controller 350 by a power transmission mechanism 342 connected to a motor (not shown). Yes. The carriage 343 is provided with an inkjet head, and droplets are ejected onto the recording paper 300 </ b> P while moving the inkjet head in the direction of arrow E based on a control signal from the controller 350. Then, the recording paper 300P is sequentially conveyed in the direction of the arrow F, whereby an image is printed on the recording paper 300P.

この構成によれば、上述した振動制御装置(コントローラー350)を備えているため、キャリッジ343を素早く、かつ、精度良く移動させるとともに、キャリッジ343が高速駆動している場合に消費電力を低減させることが可能なインクジェットプリンター300が提供できる。   According to this configuration, since the above-described vibration control device (controller 350) is provided, the carriage 343 can be moved quickly and accurately, and power consumption can be reduced when the carriage 343 is driven at high speed. Inkjet printer 300 capable of performing the above can be provided.

1…振動制御装置、10…基体、11…アクチュエーター、12…慣性センサー、13…演算部、14…伝送部、15…命令部、16…判定部、20……リンク(移動部)、30…角度センサー、31…第1の角度検出部、32…第2の角度検出部、100…液滴吐出装置(搬送装置)、200…レーザープリンター(搬送装置)、300…インクジェットプリンター(搬送装置) DESCRIPTION OF SYMBOLS 1 ... Vibration control apparatus, 10 ... Base | substrate, 11 ... Actuator, 12 ... Inertial sensor, 13 ... Operation part, 14 ... Transmission part, 15 ... Command part, 16 ... Determination part, 20 ... Link (moving part), 30 ... Angle sensor 31... First angle detector 32. Second angle detector 100. Droplet ejection device (conveyance device) 200. Laser printer (conveyance device) 300. Inkjet printer (conveyance device)

Claims (8)

基体に対して移動可能な移動部と、
前記移動部を駆動するアクチュエーターと、
前記アクチュエーターの回転角を検出する角度センサーと、
前記基体に対する前記移動部の慣性力を検出する慣性センサーと、
前記アクチュエーターに制御信号を伝送する演算部と、
前記演算部に前記角度センサーの検出信号を伝送する伝送部と、
前記演算部に命令信号を伝送する命令部と、
前記移動部の駆動速度が基準となる駆動速度よりも大きいか小さいかを判定する判定部と、を有し、
前記演算部は、前記角度センサーの検出信号のうちカットオフ周波数以下の低周波数成分と、前記慣性センサーの検出信号のうち前記カットオフ周波数以上の高周波数成分と、に基づいて前記制御信号を生成し、
前記判定部は、前記移動部の駆動速度が前記基準となる駆動速度よりも大きいと判定したときに、前記角度センサーと前記伝送部とのうち少なくとも一方を停止させる停止信号を生成することを特徴とする振動制御装置。
A moving part movable with respect to the substrate;
An actuator for driving the moving unit;
An angle sensor for detecting the rotation angle of the actuator;
An inertial sensor for detecting an inertial force of the moving part with respect to the base;
An arithmetic unit for transmitting a control signal to the actuator;
A transmission unit that transmits a detection signal of the angle sensor to the arithmetic unit;
A command unit for transmitting a command signal to the arithmetic unit;
A determination unit that determines whether the driving speed of the moving unit is larger or smaller than a reference driving speed;
The calculation unit generates the control signal based on a low-frequency component that is equal to or lower than a cutoff frequency among detection signals of the angle sensor and a high-frequency component that is equal to or higher than the cutoff frequency among detection signals of the inertial sensor. And
The determination unit generates a stop signal for stopping at least one of the angle sensor and the transmission unit when determining that the driving speed of the moving unit is higher than the reference driving speed. Vibration control device.
前記角度センサーは、第1の分解能を有する第1の角度検出部と、前記第1の分解能よりも分解能が高い第2の分解能を有する第2の角度検出部と、を有し、
前記判定部は、前記角度センサーのうち前記第2の角度検出部のみを停止させる第1の停止信号を生成することを特徴とする請求項1に記載の振動制御装置。
The angle sensor includes a first angle detection unit having a first resolution, and a second angle detection unit having a second resolution higher than the first resolution,
2. The vibration control device according to claim 1, wherein the determination unit generates a first stop signal that stops only the second angle detection unit of the angle sensor.
前記判定部は、前記角度センサーの検出信号のうちの前記高周波数成分に対応する前記伝送部における下位ビットの伝送信号を停止させる第2の停止信号を生成することを請求項1または2に記載の振動制御装置。   The said determination part produces | generates the 2nd stop signal which stops the transmission signal of the low-order bit in the said transmission part corresponding to the said high frequency component among the detection signals of the said angle sensor. Vibration control device. 前記判定部は、前記第1の停止信号と前記第2の停止信号とを同時に生成することを特徴とする請求項3に記載の振動制御装置。   The vibration control apparatus according to claim 3, wherein the determination unit simultaneously generates the first stop signal and the second stop signal. 前記基準となる駆動速度が前記命令部からの前記命令信号に基づいて設定されることを特徴とする請求項1〜4のいずれか1項に記載の振動制御装置。   The vibration control apparatus according to claim 1, wherein the reference driving speed is set based on the command signal from the command unit. 前記基準となる駆動速度が前記慣性センサーの検出信号に基づいて設定されることを特徴とする請求項1〜4のいずれか1項に記載の振動制御装置。   The vibration control apparatus according to claim 1, wherein the reference driving speed is set based on a detection signal of the inertial sensor. 前記基準となる駆動速度が前記角度センサーの検出信号に基づいて設定されることを特徴とする請求項1〜4のいずれか1項に記載の振動制御装置。   The vibration control apparatus according to claim 1, wherein the reference driving speed is set based on a detection signal of the angle sensor. 請求項1〜7のいずれか1項に記載の振動制御装置を備えていることを特徴とする搬送装置。   A conveyance device comprising the vibration control device according to claim 1.
JP2009205603A 2009-09-07 2009-09-07 Vibration control device and conveyor Withdrawn JP2011056591A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009205603A JP2011056591A (en) 2009-09-07 2009-09-07 Vibration control device and conveyor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009205603A JP2011056591A (en) 2009-09-07 2009-09-07 Vibration control device and conveyor

Publications (1)

Publication Number Publication Date
JP2011056591A true JP2011056591A (en) 2011-03-24

Family

ID=43944846

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009205603A Withdrawn JP2011056591A (en) 2009-09-07 2009-09-07 Vibration control device and conveyor

Country Status (1)

Country Link
JP (1) JP2011056591A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014233822A (en) * 2013-06-05 2014-12-15 セイコーエプソン株式会社 Robot, robot control device and robot system
WO2017145495A1 (en) * 2016-02-26 2017-08-31 セイコーエプソン株式会社 Electronic component transfer device and electronic component inspection device
CN107866810A (en) * 2016-09-27 2018-04-03 电装波动株式会社 Control device for robot

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014233822A (en) * 2013-06-05 2014-12-15 セイコーエプソン株式会社 Robot, robot control device and robot system
WO2017145495A1 (en) * 2016-02-26 2017-08-31 セイコーエプソン株式会社 Electronic component transfer device and electronic component inspection device
CN108738352A (en) * 2016-02-26 2018-11-02 精工爱普生株式会社 Electronic component handling apparatus and electronic component inspection device
CN107866810A (en) * 2016-09-27 2018-04-03 电装波动株式会社 Control device for robot

Similar Documents

Publication Publication Date Title
JP4833617B2 (en) Print medium transport apparatus and print medium transport method
JP2011056591A (en) Vibration control device and conveyor
JP4286677B2 (en) Laser marking device and laser marking method
JP2006159895A (en) Drive control device of transport belt, image forming device, and drive control method of transport belt
JP2010284725A (en) Robot device, conveyor, and control method using inertial sensor
JP2005193597A (en) Inkjet recording device
US10016990B2 (en) Print unit activation by means of a clock unit
JP2005091912A (en) Photodetector and image forming apparatus
JP5109535B2 (en) Pulse generation apparatus, image forming apparatus, and pulse generation method
JP4661445B2 (en) Encoder
JP5299157B2 (en) Image forming apparatus
JP2009048239A (en) Motor control method, motor control device, motor control program, recording medium with motor control program recorded thereon and image forming apparatus
JP2006338367A (en) Electronic equipment and control method for motor
JP5724624B2 (en) Image reading apparatus, recording apparatus, and image reading method
JP2007196427A (en) Image forming apparatus
JP2011152755A (en) Conveyance device and liquid ejection apparatus
JP2008062600A (en) Control method of printer, and control program of printer
JP2007148648A (en) Positioning control method, positioning control device and image forming device
JP2005028607A (en) Recorder
JP2021079619A (en) Liquid discharge device
JP2011167864A (en) Recording controlling apparatus and liquid jetting apparatus
JP2021079587A (en) Liquid discharge device and liquid discharge head unit
JP2007045625A (en) Carrying device and image forming device
JP2009248359A (en) Liquid jet apparatus and simultaneous operation method
JP2007283673A (en) Printer

Legal Events

Date Code Title Description
A300 Withdrawal of application because of no request for examination

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20121204