JP5167976B2 - Exhibition equipment - Google Patents
Exhibition equipment Download PDFInfo
- Publication number
- JP5167976B2 JP5167976B2 JP2008157729A JP2008157729A JP5167976B2 JP 5167976 B2 JP5167976 B2 JP 5167976B2 JP 2008157729 A JP2008157729 A JP 2008157729A JP 2008157729 A JP2008157729 A JP 2008157729A JP 5167976 B2 JP5167976 B2 JP 5167976B2
- Authority
- JP
- Japan
- Prior art keywords
- flat plate
- sensor
- sphere
- movable shaft
- ball screw
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Stepping Motors (AREA)
- Control Of Position Or Direction (AREA)
Description
本発明は、所定の軌道に沿って球体を転動させる展示装置に係り、特に、高い展示効果を実現するのに好適な展示装置に関する。 The present invention relates to an exhibition apparatus that rolls a sphere along a predetermined trajectory, and more particularly, to an exhibition apparatus suitable for realizing a high exhibition effect.
従来、展示物を展示するにあたっては、展示物の外観を美しく造形して美的効果を高めたり、斬新なレイアウトや意外な演出を採用したりするなどして、展示物への注目を集めて展示効果を高める様々な工夫がなされている。展示装置としては、例えば、特許文献1記載の展示装置が知られている。
特許文献1記載の展示装置は、水平面に対して一定の角度で傾斜する受皿を、内部に収納した展示物としての球体が外部にこぼれ出ないようにして、水平面に垂直な軸線を中心として一定の傾斜角度を維持させつつ、受皿の自転運動を規制するとともに旋回運動をさせて、球体を受皿内で転動させるものである。これにより、展示物を複雑に転がして動かすことができ、消費者に対して商品を好適に目立たせることができる。
The display device described in Patent Document 1 is fixed around an axis perpendicular to the horizontal plane so that a sphere as an exhibit housed in a tray that is inclined at a certain angle with respect to the horizontal plane does not spill outside. While maintaining the inclination angle, the rotating motion of the saucer is restricted and the turning motion is caused to roll the sphere in the saucer. Thereby, an exhibit can be rolled in a complicated manner and the product can be made conspicuous suitably for consumers.
しかしながら、特許文献1記載の展示装置にあっては、受皿を一定の傾斜角度を維持させつつ旋回運動をさせて球体を受皿内で転動させるため、球体は、受皿の旋回運動に応じて受皿の内周面との衝突を繰り返しながら受皿内で不規則に転動するだけあり、展示効果が不十分であるという問題があった。
そこで、本発明は、このような従来の技術の有する未解決の課題に着目してなされたものであって、高い展示効果を実現するのに好適な展示装置を提供することを目的としている。
However, in the display device described in Patent Document 1, the sphere is caused to rotate in the saucer while maintaining a constant inclination angle, so that the sphere rolls in the saucer. There was a problem that the display effect was insufficient because it rolled only irregularly in the tray while repeatedly colliding with the inner peripheral surface of the.
Therefore, the present invention has been made paying attention to such an unsolved problem of the conventional technology, and an object of the present invention is to provide a display device suitable for realizing a high display effect.
〔発明1〕 上記目的を達成するために、発明1の展示装置は、所定の軌道に沿って球体を転動させる展示装置であって、前記球体を転動させる平面を有する平板と、基準面に対する前記平板の傾斜を調整する傾斜調整手段と、前記平板上の前記球体の位置を検出する位置センサと、前記位置センサの検出結果に基づいて、あらかじめ設定された軌道に沿って前記平板上で前記球体が転動するように前記傾斜調整手段を制御する傾斜制御手段とを備える。 [Invention 1] In order to achieve the above object, an exhibition apparatus according to Invention 1 is an exhibition apparatus that rolls a sphere along a predetermined trajectory, a flat plate having a plane for rolling the sphere, and a reference plane. An inclination adjusting means for adjusting the inclination of the flat plate with respect to the plate, a position sensor for detecting the position of the sphere on the flat plate, and on the flat plate along a predetermined trajectory based on a detection result of the position sensor. Inclination control means for controlling the inclination adjustment means so that the sphere rolls.
このような構成であれば、位置センサにより、平板上の球体の位置が検出され、傾斜制御手段により、位置センサの検出結果に基づいて、あらかじめ設定された軌道に沿って平板上で球体が転動するように傾斜調整手段が制御される。その結果、傾斜調整手段により、基準面に対する平板の傾斜が調整されるので、球体は、あらかじめ設定された軌道に沿って平板上で転動する。
ここで、基準面とは、水平面、垂直面その他平板の傾斜の基準となる面をいう。
With such a configuration, the position of the sphere on the flat plate is detected by the position sensor, and the sphere is rotated on the flat plate along a predetermined trajectory based on the detection result of the position sensor by the inclination control means. The tilt adjusting means is controlled to move. As a result, since the inclination of the flat plate with respect to the reference plane is adjusted by the inclination adjusting means, the sphere rolls on the flat plate along a preset trajectory.
Here, the reference plane refers to a horizontal plane, a vertical plane, or other plane that serves as a reference for the inclination of the flat plate.
〔発明2〕 さらに、発明2の展示装置は、発明1の展示装置において、前記傾斜調整手段は、前記平板および固定面の間に設置され前記平板の下面の一点を支持する支持軸と、前記平板および前記固定面の間に設置され前記平板の下面の他点を上下動させる可動軸とを有する。
このような構成であれば、平板の下面の一点が支持軸により支持され、平板の下面の他点が可動軸により上下動するので、平板の傾斜を調整することができる。
[Invention 2] Further, the display device of
With such a configuration, one point on the lower surface of the flat plate is supported by the support shaft, and the other point on the lower surface of the flat plate moves up and down by the movable shaft, so that the inclination of the flat plate can be adjusted.
〔発明3〕 さらに、発明3の展示装置は、発明1および2のいずれか1の展示装置において、さらに、前記平板に固定されたセンサ取付部材を備え、前記位置センサは、前記センサ取付部材に設けられている。
このような構成であれば、平板に固定されたセンサ取付部材に位置センサが設けられているので、平板と一体に位置センサが傾斜する。そのため、平板の平面に対する位置センサの相対位置が固定されるので、平板の傾斜の度合いにかかわらず、平板上の球体の位置を精度よく検出することができる。
[Invention 3] The display device of
With such a configuration, since the position sensor is provided on the sensor mounting member fixed to the flat plate, the position sensor is inclined integrally with the flat plate. Therefore, since the relative position of the position sensor with respect to the plane of the flat plate is fixed, the position of the sphere on the flat plate can be accurately detected regardless of the degree of inclination of the flat plate.
〔発明4〕 さらに、発明4の展示装置は、発明3の展示装置において、さらに、前記平板の面方向と直交する方向の軸回りに前記位置センサを回転させるセンサ回転手段と、前記位置センサの検出結果に基づいて、前記平板上の前記球体が前記位置センサの測定領域に属するように前記センサ回転手段を制御する回転制御手段とを備える。
[Invention 4] The display device of
このような構成であれば、回転制御手段により、位置センサの検出結果に基づいて、平板上の球体が位置センサの測定領域に属するようにセンサ回転手段が制御される。その結果、センサ回転手段により、平板の面方向と直交する方向の軸回りに位置センサが回転するので、平板上の球体の位置にかかわらず、平板上の球体が位置センサの測定領域に属することとなる。したがって、平板上の球体の位置を精度よく検出することができる。 If it is such a structure, a sensor rotation means will be controlled by a rotation control means so that the spherical body on a flat plate may belong to the measurement area | region of a position sensor based on the detection result of a position sensor. As a result, since the position sensor rotates around the axis in the direction orthogonal to the plane direction of the flat plate by the sensor rotating means, the sphere on the flat plate belongs to the measurement area of the position sensor regardless of the position of the sphere on the flat plate. It becomes. Therefore, the position of the sphere on the flat plate can be detected with high accuracy.
〔発明5〕 一方、上記目的を達成するために、発明5の展示装置の水平位置決め方法は、平面を有する平板と、前記平板および固定面の間に設置され前記平板の下面の一点を支持する支持軸と、前記平板および前記固定面の間に設置され前記平板の下面の他点を上下動させる可動軸と、前記可動軸を上下動させるための力を付与するアクチュエータと、前記アクチュエータを制御して前記平板の傾斜を制御する傾斜制御手段と、前記アクチュエータの位置を検出するインクリメンタル型のエンコーダと、前記可動軸の移動と共に同方向に移動するセンサ検出子と、前記平板の平面が水平となった位置で前記センサ検出子を検出するセンサとを有した展示装置における、前記平板の水平位置決め行う方法であって、前記傾斜制御手段に、動作開始点から前記平板が水平となる方向に前記可動軸を移動させ、前記エンコーダのZ相を検出したときに、その検出位置で前記可動軸を停止するように制御させる第1の移動ステップと、前記第1の移動ステップにおいて前記可動軸が停止されたときに、前記エンコーダに、パルスのカウント値をリセットさせるカウントリセットステップと、前記傾斜制御手段に、前記第1の移動ステップにおける停止位置から前記センサが前記センサ検出子を検出するまで前記可動軸を移動させ、検出位置において前記可動軸を停止するように制御させる第2の移動ステップと、前記傾斜制御手段に、前記第2の移動ステップにおいて前記可動軸が停止されたときに、前記第2の移動ステップにおける移動方向とは逆方向に、且つ前記エンコーダのZ相が検出されるまで前記可動軸を移動するように制御させる第3の移動ステップと、前記傾斜制御手段に、前記第3の移動ステップにおいて前記Z相が検出されたときに、該検出位置から、予め設定された該検出位置から前記平板が水平となるまでの移動量を前記可動軸を移動するように制御させる第4の移動ステップとを含む。 [Invention 5] On the other hand, in order to achieve the above object, the horizontal positioning method of the exhibition apparatus of Invention 5 is provided between a flat plate having a flat surface and a lower surface of the flat plate that is installed between the flat plate and the fixed surface. A support shaft, a movable shaft that is installed between the flat plate and the fixed surface and moves the other point of the lower surface of the flat plate up and down, an actuator that applies a force to move the movable shaft up and down, and controls the actuator An inclination control means for controlling the inclination of the flat plate, an incremental encoder for detecting the position of the actuator, a sensor detector that moves in the same direction as the movable shaft, and the flat surface of the flat plate is horizontal. In the display device having a sensor for detecting the sensor detector at a position, the method for horizontally positioning the flat plate, wherein the tilt control means operates A first moving step for controlling the movable shaft to stop at the detection position when the movable shaft is moved in a direction in which the flat plate is horizontal from a starting point and the Z phase of the encoder is detected; A count reset step for causing the encoder to reset a count value of a pulse when the movable shaft is stopped in the first movement step; and the tilt control means for detecting the sensor from the stop position in the first movement step. Moving the movable shaft until the sensor detector is detected and controlling the movable shaft to stop at the detection position, and causing the tilt control means to move the movable shaft in the second moving step. When the movable shaft is stopped, the Z phase of the encoder is detected in the direction opposite to the moving direction in the second moving step. A third movement step for controlling the movable shaft to move until it is released, and when the Z phase is detected in the third movement step by the tilt control means, the detection position is set in advance. And a fourth moving step for controlling the amount of movement from the detected position until the flat plate becomes horizontal to move the movable shaft.
このような構成であれば、動作開始位置から可動軸を移動し、Z相が検出された位置でエンコーダのパルスカウント値をリセットし、更にセンサがセンサ検出子を検出する位置まで可動軸を移動し、センサ検出子が検出されると、その検出位置から最も近い位置のZ相が検出されるまで可動軸をこれまでとは逆方向に移動し、更に、Z相の検出位置から、予め水準器などで測定された正確な水平位置まで可動軸を移動させることができる。 In such a configuration, the movable shaft is moved from the operation start position, the encoder pulse count value is reset at the position where the Z phase is detected, and the movable shaft is further moved to a position where the sensor detects the sensor detector. When the sensor detector is detected, the movable shaft is moved in the opposite direction until the Z phase closest to the detection position is detected, and the level is previously determined from the Z phase detection position. The movable shaft can be moved to an accurate horizontal position measured with a measuring instrument.
これにより、可動軸の動作開始位置によらずに、センサの検出位置を基準にエンコーダの位置検出精度で展示装置の平板の水平位置決めを行うことができるので、センサ検出子で水平位置を検出したときの検出位置と、水準器などを用いて測定された正確な水平位置との誤差を低減することができる。
ここで、上記エンコーダは、アクチュエータの種類に応じてリニアエンコーダ、ロータリエンコーダなどが該当する。
As a result, the horizontal position of the flat plate of the display device can be determined with the position detection accuracy of the encoder based on the detection position of the sensor, regardless of the operation start position of the movable shaft, so the horizontal position is detected by the sensor detector. It is possible to reduce the error between the time detection position and the accurate horizontal position measured using a level or the like.
Here, the encoder corresponds to a linear encoder, a rotary encoder, or the like depending on the type of actuator.
また、上記センサ検出子は、ドグなどの可動軸に直接取り付ける(または一体形成する)もの、可動軸と共に移動する他の構成部に取り付けるもの、可動軸の一部を検出子とするもの、可動軸と共に移動する他の構成部又はその一部を検出子とするものなどが該当する。
また、上記センサは、センサ検出子を検出できるものであればどのようなセンサでもよく、例えば、フォトセンサ、超音波センサなどが該当する。
The sensor detector may be directly attached to (or integrally formed with) a movable shaft such as a dog, attached to another component that moves together with the movable shaft, or a portion of the movable shaft as a detector. Other constituent parts that move with the shaft or parts thereof that are detectors are applicable.
The sensor may be any sensor as long as it can detect a sensor detector. For example, a photo sensor, an ultrasonic sensor, or the like is applicable.
以上説明したように、発明1の展示装置によれば、あらかじめ設定された軌道に沿って平板上で球体が転動するので、球体が不規則な軌跡ではなく所定の軌跡を描くこととなり、従来に比して、高い展示効果を実現することができるという効果が得られる。
さらに、発明3の展示装置によれば、平板の平面に対する位置センサの相対位置が固定されるので、平板の傾斜の度合いにかかわらず、平板上の球体の位置を精度よく検出することができるという効果が得られる。
As described above, according to the display device of the first aspect, since the sphere rolls on the flat plate along the preset trajectory, the sphere draws a predetermined trajectory instead of an irregular trajectory. Compared to the above, an effect that a high display effect can be realized is obtained.
Furthermore, according to the display device of the
さらに、発明4の展示装置によれば、平板上の球体の位置にかかわらず、平板上の球体が位置センサの測定領域に属することとなるので、平板上の球体の位置を精度よく検出することができるという効果が得られる。
また、発明5の展示装置の水平位置決め方法によれば、可動軸の動作開始位置によらずに、センサの検出位置を基準にしてエンコーダの位置検出精度で展示装置の平板の水平位置決めを行うことができるので、高精度な平板の水平位置決めを行うことができるという効果が得られる。
Furthermore, according to the display device of the
Further, according to the horizontal positioning method of the display device of the invention 5, the flat positioning of the flat plate of the display device is performed with the position detection accuracy of the encoder on the basis of the detection position of the sensor, regardless of the operation start position of the movable shaft. Therefore, it is possible to obtain an effect that a highly accurate flat plate can be horizontally positioned.
〔第1の実施の形態〕
以下、本発明の第1の実施の形態を図面を参照しながら説明する。図1ないし図4は、本発明に係る展示装置の第1の実施の形態を示す図である。
まず、本発明を適用する展示装置100の構成を説明する。
図1は、展示装置100の設置状態を示す図である。
[First Embodiment]
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. 1 to 4 are diagrams showing a first embodiment of an exhibition apparatus according to the present invention.
First, the configuration of the
FIG. 1 is a diagram illustrating an installation state of the
展示装置100は、図1に示すように、水平面に対する平板12の傾斜を変化させながら、あらかじめ設定された所定の円軌道に沿って平板12上で球体10を転動させ、そのような演出によって展示を行うことを目的とした装置である。
図1においては、架台110の上に2台の展示装置100が隣接して配置されている。2台の展示装置100は、同一機能を有して構成されており、同一の円軌道に沿って同一または所定の位相で球体10がそれぞれ転動するように同期制御される。同期制御は、例えば、2つの球体10に対してシンクロ、ミラー等の動作をさせることにより行う。
As shown in FIG. 1, the
In FIG. 1, two
図2は、展示装置100の外観構造を示す図である。
展示装置100は、図2に示すように、球体10を転動させる平面を有する平板12と、ベース14と、平板12およびベース14の間に設置され平板12の下面の一点を支持する支持軸16と、平板12およびベース14の間に設置され平板12の下面の2点をそれぞれ独立に上下動させる2つの可動軸18とを有して構成されている。
FIG. 2 is a diagram illustrating an external structure of the
As shown in FIG. 2, the
支持軸16および可動軸18は、ボールジョイントを介して平板12の下面にその一端が固定されている。これにより、平板12の傾斜角の変化に追従して平板12を支持することができる。平面の傾斜角が変化した場合に、支持軸16と可動軸18の距離の変化は、半径方向に移動可能なボールジョイントによって吸収する。
平板12には、平板12の一の側面から平板12の面方向に突出するセンサ取付板20aと、平板12の他の側面から平板12の面方向に突出するセンサ取付板20bとが設けられている。
One end of the
The
センサ取付板20a、20bの上面には、ダイレクトドライブモータ等からなるセンサモータ22a、22bがそれぞれ設けられている。センサモータ22a、22bは、1周あたり100万分割程度の高精度角度センサを有し、角度センサによりモータ角度を出力する。センサモータ22a、22bの回転軸は、平板12の面方向と直交する方向に向けられており、それらの回転軸には、平板12上の球体10の位置を検出するレーザ変位計等からなる位置センサ24a、24bがそれぞれ取り付けられている。したがって、位置センサ24a、24bは、センサ取付板20a、20bを介して平板12と一体に傾斜するので、平板12の平面に対する位置センサ24a、24bの相対位置が固定される。また、平板12の面方向と直交する方向の軸回りに回転するので、平板12上の球体10が位置センサ24a、24bの測定領域に常に属するように、転動する球体10を追尾することができる。これにより、平板12上の球体10の位置を精度よく検出することができる。
次に、可動軸18の構成を説明する。
図3は、可動軸18の外観構造を示す図である。
可動軸18は、図3に示すように、ボールねじモータ30と、ベース14に固定されボールねじモータ30を収容する台座32と、台座32の背面に取り付けられ、台座32から垂直方向に突出する背板34と、ボールねじモータ30の回転軸に連結するボールねじ36と、ボールねじ36とボールを介して螺合するボールナット38と、背板34に取り付けられ、ボールナット38を上下方向にガイドするリニアガイド40とを有して構成されている。
Next, the configuration of the
FIG. 3 is a diagram showing an external structure of the
As shown in FIG. 3, the
可動軸18は、さらに、ボールナット38に固定され、ボールねじ36を挿通する筒状部材42と、筒状部材42の上端に一端を連結するボールジョイント44と、ボールジョイント44の他端に連結する平板取付ヘッド46とを有して構成されている。そして、平板取付ヘッド46の上面は、平板12の下面に接着されている。
ボールナット38は、ボールねじモータ30の回転駆動によりボールねじ36が回転することに伴ってリニアガイド40に沿って上下動する。そして、筒状部材42、ボールジョイント44および平板取付ヘッド46がボールナット38と一体に上下動するので、平板取付ヘッド46との接合点において平板12が上下動する。
The
The
したがって、平板12は、平板12の下面の一点が支持軸16により支持され、平板12の下面の2点が可動軸18により独立に上下動するので、水平面に対して任意の傾斜角で傾斜することができる。
Accordingly, the
次に、展示装置100の制御部を説明する。
図4は、展示装置100の制御ブロック図である。
展示装置100の制御部は、図4に示すように、あらかじめ設定された目標軌道から目標とする平板12の目標傾斜角を生成する目標傾斜角生成部60と、目標軌道から目標とする球体10の目標速度を生成する目標速度生成部62とを有して構成されている。
目標軌道は、平板12の平面の左右方向をx軸、前後方向をy軸とし、平板12上の球体10のx座標をx、y座標をy、時間をtとすると、下式(1)、(2)により表すことができる。
x=Xo(t) …(1)
y=Yo(t) …(2)
Next, the control unit of the
FIG. 4 is a control block diagram of the
As shown in FIG. 4, the control unit of the
The target trajectory is expressed by the following equation (1), where the left-right direction of the plane of the
x = Xo (t) (1)
y = Yo (t) (2)
目標軌道としては、少なくとも3段階微分可能な軌道を用意する。例えば、円軌道の場合、初期位置(x,y)=(0,0)から速度および加速度ゼロで球体10の転動を開始するとすると、目標軌道は、下式(3)、(4)により表すことができる。
x=R・cos(t/c)・K …(3)
y=R・sin(t/c)・K …(4)
K=tanh(t・A3)
上式(3)、(4)において、Rは回転半径、Cは回転周期、Aは立ち上がり定数である。
As a target trajectory, a trajectory capable of differentiating at least three stages is prepared. For example, in the case of a circular orbit, if the rolling of the
x = R · cos (t / c) · K (3)
y = R · sin (t / c) · K (4)
K = tanh (t · A 3 )
In the above equations (3) and (4), R is a radius of rotation, C is a rotation period, and A is a rising constant.
目標傾斜角生成部60は、目標軌道x、yから目標傾斜角θxo、θyoを算出する。平板12の平面を球体10が転動する運動方程式は、下式(5)により近似することができる。
x′′=5/7・g・θ …(5)
上式(5)において、「′」の記号は時間微分を意味する。
The target
x ″ = 5/7 · g · θ (5)
In the above equation (5), the symbol “′” means time differentiation.
そして、上式(5)をもとに摩擦の補正を考慮すると、目標傾斜角度θxo、θyoは、目標軌道x、yから下式(6)、(7)により算出することができる。
θxo=Xo′′(t)・K+fx …(6)
θyo=Yo′′(t)・K+fy …(7)
Then, considering the friction correction based on the above equation (5), the target inclination angles θxo and θyo can be calculated from the target trajectories x and y by the following equations (6) and (7).
θxo = Xo ″ (t) · K + fx (6)
θyo = Yo ″ (t) · K + fy (7)
目標速度生成部62は、目標軌道x、yから目標速度Vxo、Vyoを下式(8)、(9)により算出する。
Vxo=x′(t) …(8)
Vyo=y′(t) …(9)
The
Vxo = x ′ (t) (8)
Vyo = y '(t) (9)
展示装置100の制御部は、さらに、位置センサ24a、24bの検出結果に基づいて平板12上の球体10の中心位置を算出する玉中心位置算出部64と、玉中心位置算出部64で算出した球体10の中心位置に基づいて平板12上の球体10の中心位置および速度を算出する玉位置オブザーバ部66と、玉位置オブザーバ部66で算出した球体10の中心位置に基づいてセンサモータ22a、22bの回転角を生成するセンサモータ回転角生成部68とを有して構成されている。
The control unit of the
玉中心位置算出部64は、センサモータ22a、22bの回転軸の回転角度を示すモータ角度MS1、MS2をセンサモータ22a、22bから入力し、位置センサ24a、24bで測定した球体10までの距離L1、L2を位置センサ24a、24bから入力し、入力したモータ角度MS1、MS2および距離L1、L2に基づいて、平板12上の球体10の中心位置Xc、Ycを算出する。センサモータ22a、22bと位置センサ24a、24bの配置関係、および球体10の径が既知であるので、センサモータ22a、22bおよび位置センサ24a、24bからの入力値およびそれら既知の値から幾何学計算により球体10の中心位置Xc、Ycを算出することができる。
The ball center
玉位置オブザーバ部66は、球体10の中心位置Xc、Ycを玉中心位置算出部64から入力し、ボールねじモータ30の回転軸の回転角度を示すモータ角度Z1、Z2を各可動軸18のボールねじモータ30から入力し、入力した球体10の中心位置Xc、Ycおよびモータ角度Z1、Z2に基づいて、平板12上の球体10の中心位置Xc_e、Yc_eおよび速度VXc_e、VYc_eを算出する。
The ball
光沢のある曲面を有する球体10を位置センサ24a、24bで測定すると、ノイズや大きな誤差が出やすい。すなわち、距離L1、L2から直接的に算出される球体10の位置および速度は、制御には使えない。モータ角度Z1、Z2から算出される平板12の傾斜および上式(5)の運動方程式により、目標とする球体10の目標位置を算出することができる。そして、球体10の目標位置と中心位置Xc、Ycを比較してオブザーバを組み、位置センサ24a、24bの高周波のノイズや大きな測定誤差を取り除くことで制御に使える中心位置Xc_e、Yc_eおよび速度VXc_e、VYc_eを算出する。
When the
センサモータ回転角生成部68は、球体10の中心位置Xc_e、Yc_eを玉位置オブザーバ部66から入力し、遅れ補正用速度信号である目標速度Vxo、Vyoを目標速度生成部62から入力し、入力した球体10の中心位置Xc_e、Yc_eおよび目標速度Vxo、Vyoに基づいて、センサモータ22a、22bの回転軸の回転角度を指示するモータ角度指令MS1r、MS2rを生成し、生成したモータ角度指令MS1r、MS2rをセンサモータ22a、22bに出力する。
The sensor motor rotation
センサモータ回転角生成部68は、位置センサ24a、24bのレーザを、平板12上を転動する球体10の中心に向けるためセンサモータ22a、22bを駆動する。しかし、球体10の中心にレーザを向けると、レーザ光源が球体10に正反射し測定が乱れるため、球体10の中心から少しオフセットした位置を狙うことが好ましい。さらに、センサモータ22a、22bの応答の遅れを見込み、目標速度Vxo、Vyoをもとに、センサモータ22a、22bの狙い角を少し球体10の進行方向前方に定める。つまり、球体10の速度が速ければ速いほど、遅れ補正のゲインが大きくなるので、遅いときの行き過ぎを無くすために進行方向前方に定める。これにより、トラッキング性能を向上することができる。
The sensor motor
展示装置100の制御部は、さらに、目標速度生成部62から入力した目標速度Vxo、Vyoと玉位置オブザーバ部66から入力した球体10の速度VXc_e、VYc_eの差分を演算する減算部70と、減算部70の演算結果に所定の速度ゲインKvを乗算するゲイン部72と、目標傾斜角生成部60から入力した目標傾斜角度θxo、θyoとゲイン部72の演算結果を加算する加算部74とを有して構成されている。
The control unit of the
展示装置100の制御部は、さらに、目標軌道x、yと玉位置オブザーバ部66から入力した球体10の中心位置Xc_e、Yc_eの差分を演算する減算部76と、減算部76の演算結果に所定の位置ゲインKpを乗算するゲイン部78と、加算部74の演算結果とゲイン部78の演算結果を加算してその演算結果を傾斜角度指令θx、θyとして出力する加算部80とを有して構成されている。
The control unit of the
展示装置100の制御部は、さらに、加算部80の演算結果に基づいてボールねじモータ30の回転軸の回転角度を指示するモータ角度指令Z1r、Z2rを生成するボールねじモータ回転角生成部82を有して構成されている。
ボールねじモータ回転角生成部82は、傾斜角度指令θx、θyを加算部80から入力し、支持軸16および2つの可動軸18の3点支持の位置関係および傾き微小とした線形近似により、入力した傾斜角度指令θx、θyからボールねじ36の高さ(回転角)をモータ角度指令Z1r、Z2rとして算出する。モータ角度指令Z1r、Z2rは、下式(10)、(11)により算出することができる。
Z1r=A11・θx+A12・θy …(10)
Z2r=A21・θx+A22・θy …(11)
上式(10)、(11)において、A11〜A22は定数である。
The control unit of the
The ball screw motor rotation
Z1r = A11 · θx + A12 · θy (10)
Z2r = A21 · θx + A22 · θy (11)
In the above formulas (10) and (11), A11 to A22 are constants.
そして、ボールねじモータ回転角生成部82は、モータ角度指令Z1r、Z2rを各可動軸18のボールねじモータ30に出力する。
次に、本実施の形態の動作を説明する。
目標軌道x、yを上式(3)、(4)として定義し、初期位置(x,y)=(0,0)から速度および加速度ゼロで球体10の転動を開始すると、目標傾斜角生成部60により、目標軌道x、yから目標傾斜角度θxo、θyoが算出され、目標速度生成部62により、目標軌道x、yから目標速度Vxo、Vyoが算出される。
Then, the ball screw motor
Next, the operation of the present embodiment will be described.
When the target trajectories x and y are defined as the above formulas (3) and (4) and the rolling of the
次いで、位置センサ24a、24bにより、平板12上の球体10の位置が検出される。そして、玉中心位置算出部64により、位置センサ24a、24bの検出結果に基づいて平板12上の球体10の中心位置Xc、Ycが算出され、玉位置オブザーバ部66により、算出された球体10の中心位置Xc、Ycに基づいて平板12上の球体10の中心位置Xc_e、Yc_eおよび速度VXc_e、VYc_eが算出される。
Next, the position of the
次いで、減算部70により、目標速度Vxo、Vyoと球体10の速度VXc_e、VYc_eの差分が演算され、ゲイン部72により、その差分値に速度ゲインKvが乗算され、加算部74により、目標傾斜角度θxo、θyoとゲイン部72の演算結果が加算される。また、減算部76により、目標軌道x、yと球体10の中心位置Xc_e、Yc_eの差分が演算され、ゲイン部78により、その差分値に位置ゲインKpが乗算され、加算部80により、加算部74の演算結果とゲイン部78の演算結果が加算される。
Next, the difference between the target speeds Vxo and Vyo and the speeds VXc_e and VYc_e of the
そして、ボールねじモータ回転角生成部82により、加算部80からの傾斜角度指令θx、θyからモータ角度指令Z1r、Z2rが生成され、生成されたモータ角度指令Z1r、Z2rが各可動軸18のボールねじモータ30に出力される。その結果、ボールねじモータ30の回転駆動により可動軸18が上下動し、目標軌道x、yに沿って平板12上で球体10が転動するように平板12の傾斜が調整される。したがって、球体10は、目標軌道x、yに沿って平板12上で転動する。
Then, the ball screw motor rotation
一方、センサモータ回転角生成部68により、球体10の中心位置Xc_e、Yc_eおよび目標速度Vxo、Vyoからモータ角度指令MS1r、MS2rが生成され、生成されたモータ角度指令MS1r、MS2rがセンサモータ22a、22bに出力される。その結果、センサモータ22a、22bにより、平板12上の球体10が位置センサ24a、24bの測定領域に属するように位置センサ24a、24bが回転する。
On the other hand, the sensor motor rotation
このようにして、本実施の形態では、球体10を転動させる平面を有する平板12と、ベース14と、平板12およびベース14の間に設置され平板12の下面の一点を支持する支持軸16と、平板12およびベース14の間に設置され平板12の下面の2点をそれぞれ独立に上下動させる2つの可動軸18と、平板12上の球体10の位置を検出する位置センサ24a、24bと、位置センサ24a、24bの検出結果に基づいて、目標軌道x、yに沿って平板12上で球体10が転動するように可動軸18を制御する制御部とを備える。
In this manner, in the present embodiment, the
これにより、目標軌道x、yに沿って平板12上で球体10が転動するので、球体10が不規則な軌跡ではなく所定の軌跡を描くこととなり、従来に比して、高い展示効果を実現することができる。
さらに、本実施の形態では、平板12に固定されたセンサ取付板20a、20bを備え、位置センサ24a、24bは、センサ取付板20a、20bに設けられている。
Thereby, since the
Further, in the present embodiment,
これにより、平板12の平面に対する位置センサ24a、24bの相対位置が固定されるので、平板12の傾斜角にかかわらず、平板12上の球体10の位置を精度よく検出することができる。
さらに、本実施の形態では、平板12の面方向と直交する方向の軸回りに位置センサ24a、24bを回転させるセンサモータ22a、22bと、位置センサ24a、24bの検出結果に基づいて、平板12上の球体10が位置センサ24a、24bの測定領域に属するようにセンサモータ22a、22bを制御する制御部とを備える。
Thereby, since the relative position of the
Furthermore, in this embodiment, the
これにより、平板12上の球体10の位置にかかわらず、平板12上の球体10が位置センサ24a、24bの測定領域に属することとなるので、平板12上の球体10の位置を精度よく検出することができる。
さらに、本実施の形態では、平板12の下面と支持軸16および可動軸18をボールジョイントを介して接続した。
Accordingly, the
Furthermore, in the present embodiment, the lower surface of the
これにより、平板12の傾斜角の変化に追従して平板12を支持することができる。
上記第1の実施の形態において、支持軸16および可動軸18は、発明1または2の傾斜調整手段に対応し、展示装置100の制御部は、発明1の傾斜制御手段、または発明4の回転制御手段に対応し、センサ取付板20a、20bは、発明3のセンサ取付部材に対応している。また、センサモータ22a、22bは、発明4のセンサ回転手段に対応している。
Thereby, the
In the first embodiment, the
〔第2の実施の形態〕
次に、本発明の第2の実施の形態を図面を参照しながら説明する。図5ないし図6は、本発明に係る展示装置の水平位置決め方法の第2の実施の形態を示す図である。
[Second Embodiment]
Next, a second embodiment of the present invention will be described with reference to the drawings. 5 to 6 are views showing a second embodiment of the horizontal positioning method of the display device according to the present invention.
上記第1の実施の形態における展示装置100の制御部において、平板12の初期位置を特に考慮せずに、球体10を目標軌道x、yに沿って移動させているのに対して、本実施の形態では、球体10を移動させる前に、平板12を水平位置に位置決めする制御を行う。
In the control unit of the
まず、本実施の形態の展示装置100の構成を説明する。
本実施の形態の展示装置100は、図示しないが、上記第1の実施の形態の展示装置100に追加する形で、各可動軸18のボールねじ36の移動と共に同方向に移動するセンサ検出子200(例えば、ドグなど)と、ボールねじ36が平板12を水平とする位置に移動したときに、各センサ検出子200を検出するフォトセンサ26(例えば、フォトリフレクタ、フォトインタラプタなど)とを備えた構成となっている。
First, the structure of the
Although not shown, the
次に、図5に基づき、本実施の形態の展示装置100の制御部の構成を説明する。
ここで、図5は、本実施の形態の展示装置100の制御部の構成を示すブロック図である。
図5に示すように、本実施の形態の展示装置100の制御部は、ボールねじモータ30の回転角度位置を検出する位置検出器として、各ボールねじモータ30がインクリメンタル型のロータリエンコーダを有する。
Next, based on FIG. 5, the structure of the control part of the
Here, FIG. 5 is a block diagram showing the configuration of the control unit of the
As shown in FIG. 5, the control unit of the
本実施の形態の制御部は、更に、上記第1の実施の形態の展示装置100の制御部に追加する形で、平板12の水平位置決めを行う水平位置決め部84を含んだ構成となっている。本実施の形態では、この水平位置決め部84によって、球体10を目標軌道x、yに沿って移動させる前に(展示を行う前に)、平板12の水平位置決めを行うことが可能である。
The control unit according to the present embodiment further includes a
水平位置決め部84は、ユーザの操作部の操作や展示装置100の電源オンなどを契機に発せられる水平位置決め指令に応じて動作を開始し、フォトセンサ26の検出結果及びボールねじモータ30のロータリエンコーダの検出結果などに基づき、予め決められた手順でボールねじ36を上下動させる制御を行い、平板12の水平位置決めを行う。
より具体的に、水平位置決め部84は、水平位置決め指令を受けると、ボールねじ回転角生成部82に対して、以下の(1)〜(4)の手順でモータ角度指令Z1r、Z2rを出力し、ボールねじ36を上下動させて、平板12の水平位置決め処理を行う。なお、以下の(1)〜(4)の処理は、各可動軸18のボールねじ36に対して行われる。
The
More specifically, when receiving a horizontal positioning command, the
ここで、図6は、水平位置決め部84において実行される平板12の水平位置決め処理の手順を示す図である。
(1)図6に示すように、動作開始点から、平板12が水平になる方向にボールねじ36が所定速度で移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、ボールねじ36が移動後に、最初にロータリエンコーダでZ相が検出されると、その検出位置でボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。このとき、ボールねじモータ30のロータリエンコーダに対して、位置検出用パルスのカウント値をリセットさせるリセット指令を与える。これにより、Z相が検出された位置でロータリエンコーダの位置検出用パルスのカウント値がリセットされる。
Here, FIG. 6 is a diagram illustrating a procedure of the horizontal positioning process of the
(1) As shown in FIG. 6, a motor angle command is generated from the operation start point so that the
(2)上記(1)の停止位置(Z相の検出位置)から、平板12の平面が水平方向となる方向にボールねじ36が所定速度で移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、ボールねじ36が移動後に、フォトセンサ26でセンサ検出子200が検出されたると、その検出位置でボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。
(2) A motor angle command is generated so that the
(3)上記(2)の停止位置から今度は上記(2)の移動方向とは逆方向にボールねじ36が所定速度で移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、ボールねじ36が移動後に、最初にロータリエンコーダでZ相が検出されると、その検出位置でボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。
(3) A motor angle command is generated from the stop position in (2) above so that the
(4)上記(3)の停止位置(Z相の検出位置)から、上記(3)と同じ移動方向に、予め水準器などを用いて設定された、上記(3)の停止位置から平板12が水平位置となる移動距離d0だけボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじ36は、エンコーダの分解能と同じ位置精度で水平位置に向かって移動し、水平位置として検出された位置において停止する(水平位置決めされる)。
(4) From the stop position of (3) set in advance in the same movement direction as that of (3) from the stop position of (3) (Z-phase detection position) using a level or the like in advance, the flat plate 12 A motor angle command is generated so as to move the
次に、本実施の形態の動作を説明する。
ユーザによる操作部の操作によって、水平位置決め指令が水平位置決め部84に出力されると、水平位置決め部84において、平板12の水平位置決め処理が開始される。
水平位置決め部84は、各可動軸18のボールねじ36を、その初期位置からボールねじ36の位置が平板12を水平方向に近づける方向に移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が駆動し、ボールねじ36が平板12を水平方向に近づける方向に移動する。
Next, the operation of the present embodiment will be described.
When the horizontal positioning command is output to the
The
一方、ボールねじモータ30が駆動すると、ボールねじモータ30のロータリエンコーダは、内部のフォトセンサと、スリット機構とによってモータの回転に伴って発生するパルスをカウントし、ボールねじモータ30の(ボールねじ36)の回転角度位置の検出を行う。そして、ボールねじモータ30の駆動に伴って、ロータリエンコーダの回転子が回転すると、やがてロータリエンコーダにおいてZ相が検出される。
On the other hand, when the
水平位置決め部84は、ロータリエンコーダにおいてZ相が検出されると、その検出位置においてボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、Z相の検出位置において、ロータリエンコーダにパルスのカウント値をリセットするようにリセット指令を与える。これによって、リセット指令を受けたボールねじモータ30のロータリエンコーダは、パルスのカウント値をリセットする。
When the Z phase is detected by the rotary encoder, the
水平位置決め部84は、ロータリエンコーダにおいて、パルスのカウント値がリセットされると、これまでの移動方向と同じ方向に、可動軸18のボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が駆動し、ボールねじ36が平板12を水平方向に近づける方向に更に移動する。このとき、ボールねじ36の移動に伴ってセンサ検出子200も移動し、やがてフォトセンサ26において、センサ検出子200が検出される。
When the pulse count value is reset in the rotary encoder, the
水平位置決め部84は、フォトセンサ26において、センサ検出子200が検出されると、その検出位置において、ボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が停止し(またはブレーキをかけた状態になり)、ボールねじ36がセンサ検出子200の検出位置において停止する。
When the sensor detector 200 is detected in the
水平位置決め部84は、ボールねじ36がセンサ検出子200の検出位置において停止すると、今度は、これまでの移動方向とは逆方向にボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が逆回転に駆動し、ボールねじ36がこれまでとは逆方向に移動する。例えば、これまで上方向に移動していた場合は、下方向に移動する。
When the
この移動によって、ロータリエンコーダにおいてZ相が検出されると、水平位置決め部84は、この最初に検出されたZ相の検出位置において、ボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじ36が逆方向に移動後に最初にZ相が検出された位置で停止する。
水平位置決め部84は、更に、ボールねじ36が最初にZ相が検出された位置で停止すると、このZ相を検出したときと同じ移動方向に、予め水準器などで測定されたこの停止位置から平板12の平面を水平とする位置までの移動距離d0だけボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が駆動し、ボールねじ36は、ボールねじモータ30のロータリエンコーダによって検出される位置に基づき停止位置から距離d0だけ平板12が水平となる方向に移動して停止する。これにより、平板12の水平位置決めが完了する。
When the Z phase is detected in the rotary encoder by this movement, the
Further, when the
以降は、平板12上に球体10を乗せて、上記第1の実施の形態と同様に、目標軌道x、yに沿って球体10を移動させる制御が行われる。
このようにして、本実施の形態では、水平位置決め部84において、上記(1)〜(4)の手順でボールねじ36を移動させ、且つロータリエンコーダのパルスカウント値のリセットを行わせる制御を行って、平板12の水平位置決めを行うことがが可能である。
Thereafter, the control is performed such that the
In this manner, in the present embodiment, the
これにより、ボールねじ36の初期位置(動作開始点)によらずに、ボールねじモータ30の有するロータリエンコーダの位置検出精度で、平板12の水平位置決めを行うことができる。
上記第2の実施の形態において、支持軸16および可動軸18は、発明5の支持軸および可動軸に対応し、展示装置100の制御部は、発明5の傾斜制御手段に対応し、ボールねじモータ30は、発明5のアクチュエータおよびエンコーダに対応する。
Thereby, the horizontal positioning of the
In the second embodiment, the
なお、上記第1及び第2の実施の形態においては、平板12の平面の形状を矩形としたが、これに限らず、円形、楕円形その他の形状とすることもできる。
また、上記第1及び第2の実施の形態において、展示装置100は、1つの球体10を平板12上で転動させるように構成したが、これに限らず、2以上の球体10を平板12上で転動させるように構成することもできる。
In the first and second embodiments, the flat shape of the
Moreover, in the said 1st and 2nd embodiment, although the
また、上記第1及び第2の実施の形態において、あらかじめ設定された所定の円軌道に沿って平板12上で球体10を転動させる構成としたが、これに限らず、数式で表現可能な任意の軌道の組み合わせよりなる軌道に沿って平板12上で球体10を転動させる構成としてもよい。但し、この構成の場合は、各軌道を表す数式同士が3階微分まで連続である必要がある。
Moreover, in the said 1st and 2nd embodiment, it was set as the structure which rolls the
また、上記第1及び第2の実施の形態において、センサモータ22a、22bの位置を既知として、これらの取付け誤差を特に考慮せずに幾何学計算を行う構成としたが、幾何学計算を行う前に、取付け誤差を考慮したキャリブレーションを行う構成としてもよい。
このキャリブレーションは、例えば、以下の(A)〜(D)の手順で行う。
In the first and second embodiments, the positions of the
This calibration is performed by, for example, the following procedures (A) to (D).
(A)エッジのあるブロックを平板12上に置き、エッジに2つのレーザを当て、そのときのセンサモータ22a、22bの高精度角度センサの値と距離とを記録する。
(B)ブロックの位置を、6箇所以上(パラメータ数以上)変更して、それぞれの箇所における上記(A)の記録処理を行う。
(C)幾何パラメータを設計値と仮定し、センサモータ22a、22bのそれぞれの記録値からエッジの位置を計算する。
(D)上記(C)の2つの計算値は、取付け誤差が無い場合に一致するので、両者の差分をとり(例えば、差分の2乗を計算し)、すべての上記記録箇所について、差分が最小となる幾何パラメータの値を数値的に求める。
(A) A block with an edge is placed on the
(B) The block position is changed by 6 or more (the number of parameters or more), and the recording process (A) is performed at each location.
(C) Assuming that the geometric parameter is a design value, the position of the edge is calculated from the recorded values of the
(D) The two calculated values in (C) above match when there is no attachment error. Therefore, the difference between the two is taken (for example, the square of the difference is calculated), and the difference is found for all the above-mentioned recording locations. Find the minimum geometric parameter value numerically.
上記(A)〜(D)の手順で求めた幾何パラメータを用いて、幾何学計算を行うことによって、取付け誤差により生じる誤差を低減する。
なお、上記(A)〜(D)の手順で幾何パラメータをキャリブレートしても、計測距離が長ければ長いほど誤差が大きくなるので、更に、中心からのレーザ光のオフセット値を補正するようにしてもよい。例えば、現状(発生誤差の大きさ)に応じて、オフセット値を、誤差が低減する値にずらす。
By performing geometric calculation using the geometric parameters obtained in the procedures (A) to (D), errors caused by mounting errors are reduced.
Even if the geometric parameters are calibrated in the above procedures (A) to (D), the error becomes larger as the measurement distance is longer. Therefore, the offset value of the laser beam from the center is further corrected. Also good. For example, the offset value is shifted to a value that reduces the error according to the current state (the magnitude of the generated error).
また、上記第1及び第2の実施の形態において、展示装置100を、ノイズによる位置センサ24a、24bの測定距離の誤差を考慮せずに、平板12上の球体10の中心位置Xc、Ycを計算する構成としたが、これに限らず、球体10の中心位置Xc、Ycを計算する前に、測定距離のフィルタリング処理を行って、ノイズによって生じる誤差を低減する構成としてもよい。
Further, in the first and second embodiments, the
例えば、図7に示すように、展示装置100の制御部を、上記実施の形態における図4の展示装置100の制御部に、玉位置オブザーバ部66からの玉中心位置に基づき位置センサ24a、24bで測定される距離を逆算する距離逆算部90と、位置センサ24a、24bで測定した距離と、距離逆算部90で逆算した距離とに基づき、測定距離のフィルタリング処理を行うフィルタリング処理部92、94とを追加した構成とする。
For example, as shown in FIG. 7, the control unit of the
このような構成であれば、制御部は、玉中心位置算出部64において、平板12上の球体10の中心位置を算出する際に、まず、距離逆算部90において、玉位置オブザーバ部66において推定された球体10の推定位置から、位置センサ24a、24bにおいて測定されるべき距離を幾何学的に逆算する。
次に、フィルタリング処理部92において、位置センサ24aに対して逆算された距離Le(以下、逆算距離Le1と称す)と位置センサ24aで測定された距離L(L1)との差分の絶対値を算出し、該算出した差分の絶対値と予め設定された閾値Lthとを比較する。
With this configuration, when the ball center
Next, the
そして、下式(12)に示すように、差分の絶対値が閾値Lth以下の場合に、位置センサ24aの距離測定が正しく行われたと判定する。一方、下式(13)に示すように、差分の絶対値が閾値Lthよりも大きい場合に、位置センサ24aの距離測定が正しく行われなかったと判定する。
|Lt−Let|≦Lth …(12)
|Lt−Let|>Lth …(13)
但し、上式(12)、(13)において、tは時刻である。
Then, as shown in the following equation (12), when the absolute value of the difference is equal to or less than the threshold value Lth, it is determined that the distance measurement of the
| L t -Le t | ≦ Lth ... (12)
| L t -Le t |> Lth ... (13)
However, in the above formulas (12) and (13), t is time.
同様に、フィルタリング処理部92において、位置センサ24bに対する逆算距離Le(以下、逆算距離Le2と称す)と位置センサ24bで測定された測定距離L(L2)との差分の絶対値を算出し、この絶対値と閾値Lthとを比較する。そして、上式(12)に示すように、差分の絶対値が閾値Lth以下の場合に、位置センサ24bの距離測定が正しく行われたと判定する。一方、上式(13)に示すように、差分の絶対値が閾値Lthよりも大きい場合に、位置センサ24bの距離測定が正しく行われなかったと判定する。
Similarly, the
次に、フィルタリング処理部92、94において、距離測定が正しく行われたと判定された場合は、下式(14)に示すように、玉中心位置算出部64に出力する距離Lout t(以下、出力距離Lout tと称す)をLtとする。
一方、フィルタリング処理部92、94において、距離測定が正しく行われなかったと判定された場合は、下式(15)に示すように、前回の(1サイクル前の)測定距離Lt-1に、逆算距離Leの微分Le´に1サイクル時間tを乗算した「Le´×t」を加算した値を出力距離Lout tとする。
Lout t=Lt …(14)
Lout t=Lt-1+Le´×t …(15)
このように、位置センサ24a、24bの測定距離に対してフィルタリング処理を行うことで、ノイズによる大きな測定誤差や、短時間の測定エラーに対してもトラッキングを続行することができる。
Next, when it is determined in the
On the other hand, when the
L out t = L t (14)
L out t = L t−1 + Le ′ × t (15)
In this way, by performing the filtering process on the measurement distances of the
また、上記第1及び第2の実施の形態において、展示装置100の制御部は、加算部74において、目標傾斜角生成部60から入力された目標傾斜角度θxo、θyoとゲイン部72の演算結果とを加算し、加算部80において、加算部74の演算結果とゲイン部78の演算結果を加算してその演算結果を傾斜角度指令θx、θyとして出力する構成とした。この構成において、レーザで計測した距離の誤差を考慮して(オブザーバを用いたとしてもレーザの誤差を考慮する)、傾斜角度指令θx、θyの算出時に、目標軌道から生成されるθxo、θyoの寄与を大きくし、フィードバックのゲインはなるべく小さくするようにしてもよい。これによって、制御の安定性を向上することが可能である。
In the first and second embodiments, the control unit of the
また、上記第1及び第2の実施の形態において、ゲイン部72により、球体10の速度VXc_e、VYc_eの差分値に速度ゲインKvを乗算するようにしたが、速度ゲインKvは、目標速度のノルムVo(=(VXc_e2+VYc_e2)1/2)に依存するため、図8に示すように、低速時において(又は停止時において)は、ゲインKvが小さくなるように制御する構成にしてもよい。これによって、球体10が停止、又は低速移動時に制御を安定させることが可能となる。ここで、図8は、速度ゲインKvと目標速度のノルムVoとの関係を示す図である。
In the first and second embodiments, the
また、上記第1及び第2の実施の形態において、ボールねじモータ回転角生成部82により、モータ角度指令Z1r、Z2rを生成し、生成されたモータ角度指令Z1r、Z2rを各可動軸18のボールねじモータ30に出力して、目標軌道x、yに沿って平板12上で球体10が転動するように平板12の傾斜を調整する制御を行うようにしたが、この制御ループにおいて、バックラッシュを除去する制御を組み込むようにしてもよい。これによって、制御の精度を向上することが可能となる。
In the first and second embodiments, the ball screw motor
100 展示装置
12 平板
10 球体
14 ベース
16 支持軸
18 可動軸
20a、20b センサ取付板
22a、22b センサモータ
24a、24b 位置センサ
26 フォトセンサ
30 ボールねじモータ
32 台座
34 背板
38 ボールナット
40 リニアガイド
42 筒状部材
44 ボールジョイント
46 平板取付ヘッド
60 目標傾斜角生成部
62 目標速度生成部
64 玉中心位置算出部
66 玉位置オブザーバ部
68 センサモータ回転角生成部
70、76 減算部
72、78 ゲイン部
74、80 加算部
82 ボールねじモータ回転角生成部
84 水平位置決め部
90 距離逆算部
92、94 フィルタリング処理部
DESCRIPTION OF
Claims (5)
前記球体を転動させる平面を有する平板と、基準面に対する前記平板の傾斜を調整する傾斜調整手段と、前記平板上の前記球体の位置を検出する位置センサと、前記位置センサの検出結果に基づいて、前記平板上で前記球体が転動するように前記傾斜調整手段を制御する傾斜制御手段とを備えることを特徴とする展示装置。 A display device for rolling the ball body,
Based on a flat plate having a flat surface for rolling the sphere, an inclination adjusting means for adjusting an inclination of the flat plate with respect to a reference plane, a position sensor for detecting the position of the sphere on the flat plate, and a detection result of the position sensor. Te, exhibition device the spheres before SL on a flat plate is characterized in that it comprises a tilt control means for controlling said inclination adjustment means to roll.
前記傾斜調整手段は、前記平板および固定面の間に設置され前記平板の下面の一点を支持する支持軸と、前記平板および前記固定面の間に設置され前記平板の下面の他点を上下動させる可動軸とを有することを特徴とする展示装置。 In claim 1,
The inclination adjusting means is installed between the flat plate and the fixed surface and supports a point on the lower surface of the flat plate, and is installed between the flat plate and the fixed surface to move the other point of the lower surface of the flat plate up and down. An exhibition apparatus comprising a movable shaft.
さらに、前記平板に固定されたセンサ取付部材を備え、
前記位置センサは、前記センサ取付部材に設けられていることを特徴とする展示装置。 In any one of Claim 1 and 2,
In addition, a sensor mounting member fixed to the flat plate,
The exhibition apparatus, wherein the position sensor is provided on the sensor mounting member.
さらに、前記平板の面方向と直交する方向の軸回りに前記位置センサを回転させるセンサ回転手段と、前記位置センサの検出結果に基づいて、前記平板上の前記球体が前記位置センサの測定領域に属するように前記センサ回転手段を制御する回転制御手段とを備えることを特徴とする展示装置。 In claim 3,
Further, sensor rotation means for rotating the position sensor about an axis in a direction orthogonal to the plane direction of the flat plate, and the sphere on the flat plate in the measurement region of the position sensor based on the detection result of the position sensor. An exhibition apparatus comprising rotation control means for controlling the sensor rotation means so as to belong.
前記傾斜制御手段に、動作開始点から前記平板が水平となる方向に前記可動軸を移動させ、前記エンコーダのZ相を検出したときに、その検出位置で前記可動軸を停止するように制御させる第1の移動ステップと、
前記第1の移動ステップにおいて前記可動軸が停止されたときに、前記エンコーダに、パルスのカウント値をリセットさせるカウントリセットステップと、
前記傾斜制御手段に、前記第1の移動ステップにおける停止位置から前記センサが前記センサ検出子を検出するまで前記可動軸を移動させ、検出位置において前記可動軸を停止するように制御させる第2の移動ステップと、
前記傾斜制御手段に、前記第2の移動ステップにおいて前記可動軸が停止されたときに、前記第2の移動ステップにおける移動方向とは逆方向に、且つ前記エンコーダのZ相が検出されるまで前記可動軸を移動するように制御させる第3の移動ステップと、
前記傾斜制御手段に、前記第3の移動ステップにおいて前記Z相が検出されたときに、該検出位置から、予め設定された該検出位置から前記平板が水平となるまでの移動量を前記可動軸を移動するように制御させる第4の移動ステップとを含むことを特徴とする展示装置の水平位置決め方法。 A flat plate having a flat surface, a support shaft installed between the flat plate and the fixed surface and supporting one point on the lower surface of the flat plate, and another point on the lower surface of the flat plate installed between the flat plate and the fixed surface moved up and down A movable shaft to be moved, an actuator for applying a force for moving the movable shaft up and down, a tilt control means for controlling the tilt of the flat plate by controlling the actuator, and an incremental encoder for detecting the position of the actuator Positioning of the flat plate in an exhibition apparatus comprising: a sensor detector that moves in the same direction as the movable shaft; and a sensor that detects the sensor detector at a position where the flat surface of the flat plate is horizontal. A way to do,
The tilt control means moves the movable shaft in a direction in which the flat plate is horizontal from an operation start point, and controls the movable shaft to stop at the detection position when the Z phase of the encoder is detected. A first moving step;
A count reset step for causing the encoder to reset a pulse count value when the movable shaft is stopped in the first movement step;
A second control unit that controls the tilt control unit to move the movable shaft from the stop position in the first movement step until the sensor detects the sensor detector, and to stop the movable shaft at the detection position; A moving step;
When the movable shaft is stopped in the second movement step, the tilt control means is in a direction opposite to the movement direction in the second movement step and until the Z phase of the encoder is detected. A third movement step for controlling the movable axis to move;
When the Z phase is detected in the third movement step, the tilt control means determines the amount of movement from the detection position until the flat plate becomes horizontal from the preset detection position. And a fourth moving step for controlling the display device to move.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008157729A JP5167976B2 (en) | 2007-10-23 | 2008-06-17 | Exhibition equipment |
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2007274774 | 2007-10-23 | ||
| JP2007274774 | 2007-10-23 | ||
| JP2008157729A JP5167976B2 (en) | 2007-10-23 | 2008-06-17 | Exhibition equipment |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2009122635A JP2009122635A (en) | 2009-06-04 |
| JP2009122635A5 JP2009122635A5 (en) | 2011-06-30 |
| JP5167976B2 true JP5167976B2 (en) | 2013-03-21 |
Family
ID=40814803
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2008157729A Expired - Fee Related JP5167976B2 (en) | 2007-10-23 | 2008-06-17 | Exhibition equipment |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5167976B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106959621B (en) * | 2016-01-12 | 2023-09-01 | 上海优爱宝智能机器人科技股份有限公司 | Matrix display device |
| CN112945071B (en) * | 2021-02-02 | 2022-11-04 | 永康市杰地希机器人科技有限公司 | System and method for detecting panel state on line |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0465702A (en) * | 1990-07-05 | 1992-03-02 | Fujitsu Ltd | Method for searching origin of robot |
| JPH07199034A (en) * | 1993-12-30 | 1995-08-04 | Canon Inc | Zoom lens adjustment device |
| JP2883580B2 (en) * | 1996-07-04 | 1999-04-19 | 有限会社長沼弥栄産業 | Display method and display device |
| JPH1176634A (en) * | 1997-09-05 | 1999-03-23 | Yoshiyasu Mukai | Flight exercising machine for radio-controlled hilicopter provided with rolling ball and rolling ball control board |
| JP2009011533A (en) * | 2007-07-04 | 2009-01-22 | Nsk Ltd | Exhibition equipment |
| JP2009014966A (en) * | 2007-07-04 | 2009-01-22 | Nsk Ltd | Exhibition equipment |
-
2008
- 2008-06-17 JP JP2008157729A patent/JP5167976B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2009122635A (en) | 2009-06-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7230689B2 (en) | Multi-dimensional measuring system | |
| US7779553B2 (en) | Oscillating scanning probe with constant contact force | |
| EP2431707B1 (en) | Articulating probe head | |
| JP5192196B2 (en) | Surface shape measuring device | |
| WO2003019231A1 (en) | Six dimensional laser tracking system and method | |
| US8593086B2 (en) | System and method including feed-forward control of a brushless synchronous motor | |
| US20090072774A1 (en) | Displacement sensing method and motor control apparatus | |
| JP2008089578A (en) | Surface shape measuring device | |
| EP1750085A3 (en) | Laser tracking interferometer | |
| WO2006109094A1 (en) | Method of error correction | |
| JP4443891B2 (en) | Stage equipment | |
| JP5438988B2 (en) | Measurement system and interferometer | |
| JP5167976B2 (en) | Exhibition equipment | |
| JP2010105117A (en) | Accuracy measuring method, error correction method for numerically controlled machine tool and numerically controlled machine tool with error correcting function | |
| TWI382833B (en) | Walking assistive system | |
| JP6463926B2 (en) | Displacement compensation system for machine tools | |
| JP2008139035A (en) | 3D environment measuring device and mobile robot equipped with the same | |
| JP2006155362A (en) | Rotation shaft controller | |
| JP5493844B2 (en) | Mechanism, external force detection method, and mechanism control method | |
| JP2018128350A (en) | Position detecting device, stage device, and shape measuring device | |
| JP6936703B2 (en) | Laser device and gain adjustment method for laser device | |
| US20240181587A1 (en) | Systems, methods and apparatus for control of positioning systems | |
| JP6500385B2 (en) | Moving amount estimation device, autonomous moving body, and moving amount estimation method | |
| JP2000205815A (en) | Three-dimensional displacement detecting device, wheel alignment measuring device, and three-dimensional displacement detecting method | |
| JP2012112919A (en) | Laser tracker |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110512 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110512 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20121119 |
|
| 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: 20121127 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20121210 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5167976 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |