Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP5167976B2 - Exhibition equipment - Google Patents
[go: Go Back, main page]

JP5167976B2 - Exhibition equipment - Google Patents

Exhibition equipment Download PDF

Info

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
Application number
JP2008157729A
Other languages
Japanese (ja)
Other versions
JP2009122635A (en
JP2009122635A5 (en
Inventor
康浩 岩崎
澄雄 杉田
大輔 郡司
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
NSK Ltd
Original Assignee
NSK Ltd
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 NSK Ltd filed Critical NSK Ltd
Priority to JP2008157729A priority Critical patent/JP5167976B2/en
Publication of JP2009122635A publication Critical patent/JP2009122635A/en
Publication of JP2009122635A5 publication Critical patent/JP2009122635A5/ja
Application granted granted Critical
Publication of JP5167976B2 publication Critical patent/JP5167976B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

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記載の展示装置は、水平面に対して一定の角度で傾斜する受皿を、内部に収納した展示物としての球体が外部にこぼれ出ないようにして、水平面に垂直な軸線を中心として一定の傾斜角度を維持させつつ、受皿の自転運動を規制するとともに旋回運動をさせて、球体を受皿内で転動させるものである。これにより、展示物を複雑に転がして動かすことができ、消費者に対して商品を好適に目立たせることができる。
特開平10−20823号公報
Traditionally, when exhibiting exhibits, the appearance of the exhibits has been beautifully shaped to enhance the aesthetic effect, and novel layouts and unexpected effects have been adopted to attract attention to the exhibits. Various ingenuity has been made to enhance the effect. For example, an exhibition apparatus described in Patent Document 1 is known as an exhibition apparatus.
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.
Japanese Patent Laid-Open No. 10-20823

しかしながら、特許文献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 Invention 2 is the display device of Invention 1, wherein 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; 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.
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 Invention 3 is the display device of any one of Inventions 1 and 2, further comprising a sensor mounting member fixed to the flat plate, wherein the position sensor is attached to the sensor mounting member. Is provided.
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 Invention 4 is the display device of Invention 3, further comprising: a sensor rotating means for rotating the position sensor about an axis in a direction orthogonal to the plane direction of the flat plate; Rotation control means for controlling the sensor rotation means so that the sphere on the flat plate belongs to the measurement region of the position sensor based on the detection result.

このような構成であれば、回転制御手段により、位置センサの検出結果に基づいて、平板上の球体が位置センサの測定領域に属するようにセンサ回転手段が制御される。その結果、センサ回転手段により、平板の面方向と直交する方向の軸回りに位置センサが回転するので、平板上の球体の位置にかかわらず、平板上の球体が位置センサの測定領域に属することとなる。したがって、平板上の球体の位置を精度よく検出することができる。   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 invention 3, since the relative position of the position sensor with respect to the plane of the flat plate is fixed, it is possible to accurately detect the position of the sphere on the flat plate regardless of the degree of inclination of the flat plate. An effect is obtained.

さらに、発明4の展示装置によれば、平板上の球体の位置にかかわらず、平板上の球体が位置センサの測定領域に属することとなるので、平板上の球体の位置を精度よく検出することができるという効果が得られる。
また、発明5の展示装置の水平位置決め方法によれば、可動軸の動作開始位置によらずに、センサの検出位置を基準にしてエンコーダの位置検出精度で展示装置の平板の水平位置決めを行うことができるので、高精度な平板の水平位置決めを行うことができるという効果が得られる。
Furthermore, according to the display device of the invention 4, since 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, the position of the sphere on the flat plate can be accurately detected. The effect of being able to be obtained.
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 exhibition apparatus 100 to which the present invention is applied will be described.
FIG. 1 is a diagram illustrating an installation state of the exhibition apparatus 100.

展示装置100は、図1に示すように、水平面に対する平板12の傾斜を変化させながら、あらかじめ設定された所定の円軌道に沿って平板12上で球体10を転動させ、そのような演出によって展示を行うことを目的とした装置である。
図1においては、架台110の上に2台の展示装置100が隣接して配置されている。2台の展示装置100は、同一機能を有して構成されており、同一の円軌道に沿って同一または所定の位相で球体10がそれぞれ転動するように同期制御される。同期制御は、例えば、2つの球体10に対してシンクロ、ミラー等の動作をさせることにより行う。
As shown in FIG. 1, the display apparatus 100 rolls the sphere 10 on the flat plate 12 along a predetermined circular orbit while changing the inclination of the flat plate 12 with respect to the horizontal plane. It is a device aimed at exhibiting.
In FIG. 1, two display apparatuses 100 are arranged adjacent to each other on a gantry 110. The two exhibition apparatuses 100 are configured to have the same function, and are synchronously controlled so that the spheres 10 roll in the same or predetermined phase along the same circular orbit. For example, the synchronization control is performed by causing the two spheres 10 to perform operations such as synchronization and mirroring.

図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 display device 100.
As shown in FIG. 2, the display device 100 has a flat plate 12 having a plane on which the sphere 10 rolls, a base 14, a support shaft that is installed between the flat plate 12 and the base 14 and supports one point on the lower surface of the flat plate 12. 16 and two movable shafts 18 that are installed between the flat plate 12 and the base 14 and vertically move two points on the lower surface of the flat plate 12 respectively.

支持軸16および可動軸18は、ボールジョイントを介して平板12の下面にその一端が固定されている。これにより、平板12の傾斜角の変化に追従して平板12を支持することができる。平面の傾斜角が変化した場合に、支持軸16と可動軸18の距離の変化は、半径方向に移動可能なボールジョイントによって吸収する。
平板12には、平板12の一の側面から平板12の面方向に突出するセンサ取付板20aと、平板12の他の側面から平板12の面方向に突出するセンサ取付板20bとが設けられている。
One end of the support shaft 16 and the movable shaft 18 is fixed to the lower surface of the flat plate 12 through a ball joint. Thereby, the flat plate 12 can be supported following the change in the inclination angle of the flat plate 12. When the inclination angle of the plane changes, the change in the distance between the support shaft 16 and the movable shaft 18 is absorbed by a ball joint that can move in the radial direction.
The flat plate 12 is provided with a sensor mounting plate 20 a that protrudes from one side surface of the flat plate 12 in the surface direction of the flat plate 12 and a sensor mounting plate 20 b that protrudes from the other side surface of the flat plate 12 in the surface direction of the flat plate 12. Yes.

センサ取付板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の位置を精度よく検出することができる。   Sensor motors 22a and 22b made of a direct drive motor or the like are provided on the upper surfaces of the sensor mounting plates 20a and 20b, respectively. The sensor motors 22a and 22b have high-precision angle sensors of about 1 million divisions per round, and the motor angle is output by the angle sensor. The rotational axes of the sensor motors 22a and 22b are oriented in a direction orthogonal to the surface direction of the flat plate 12, and the rotational axes are positions including a laser displacement meter that detects the position of the sphere 10 on the flat plate 12. Sensors 24a and 24b are respectively attached. Therefore, since the position sensors 24a and 24b are integrally inclined with the flat plate 12 via the sensor mounting plates 20a and 20b, the relative positions of the position sensors 24a and 24b with respect to the plane of the flat plate 12 are fixed. Further, since it rotates around an axis in a direction orthogonal to the plane direction of the flat plate 12, the rolling sphere 10 can be tracked so that the sphere 10 on the flat plate 12 always belongs to the measurement region of the position sensors 24a, 24b. it can. Thereby, the position of the sphere 10 on the flat plate 12 can be detected with high accuracy.

次に、可動軸18の構成を説明する。
図3は、可動軸18の外観構造を示す図である。
可動軸18は、図3に示すように、ボールねじモータ30と、ベース14に固定されボールねじモータ30を収容する台座32と、台座32の背面に取り付けられ、台座32から垂直方向に突出する背板34と、ボールねじモータ30の回転軸に連結するボールねじ36と、ボールねじ36とボールを介して螺合するボールナット38と、背板34に取り付けられ、ボールナット38を上下方向にガイドするリニアガイド40とを有して構成されている。
Next, the configuration of the movable shaft 18 will be described.
FIG. 3 is a diagram showing an external structure of the movable shaft 18.
As shown in FIG. 3, the movable shaft 18 is attached to the ball screw motor 30, a base 32 that is fixed to the base 14 and accommodates the ball screw motor 30, is attached to the back surface of the base 32, and protrudes vertically from the base 32. A back plate 34, a ball screw 36 connected to the rotating shaft of the ball screw motor 30, a ball nut 38 screwed to the ball screw 36 via the ball, and a back plate 34 are attached to the ball nut 38 in the vertical direction. And a linear guide 40 for guiding.

可動軸18は、さらに、ボールナット38に固定され、ボールねじ36を挿通する筒状部材42と、筒状部材42の上端に一端を連結するボールジョイント44と、ボールジョイント44の他端に連結する平板取付ヘッド46とを有して構成されている。そして、平板取付ヘッド46の上面は、平板12の下面に接着されている。
ボールナット38は、ボールねじモータ30の回転駆動によりボールねじ36が回転することに伴ってリニアガイド40に沿って上下動する。そして、筒状部材42、ボールジョイント44および平板取付ヘッド46がボールナット38と一体に上下動するので、平板取付ヘッド46との接合点において平板12が上下動する。
The movable shaft 18 is further fixed to the ball nut 38 and is connected to the cylindrical member 42 through which the ball screw 36 is inserted, the ball joint 44 having one end connected to the upper end of the cylindrical member 42, and the other end of the ball joint 44. And a flat plate mounting head 46. The upper surface of the flat plate mounting head 46 is bonded to the lower surface of the flat plate 12.
The ball nut 38 moves up and down along the linear guide 40 as the ball screw 36 rotates as the ball screw motor 30 rotates. Since the cylindrical member 42, the ball joint 44 and the flat plate mounting head 46 move up and down integrally with the ball nut 38, the flat plate 12 moves up and down at the joint point with the flat plate mounting head 46.

したがって、平板12は、平板12の下面の一点が支持軸16により支持され、平板12の下面の2点が可動軸18により独立に上下動するので、水平面に対して任意の傾斜角で傾斜することができる。   Accordingly, the flat plate 12 is supported at one point on the lower surface of the flat plate 12 by the support shaft 16, and the two points on the lower surface of the flat plate 12 are moved up and down independently by the movable shaft 18. be able to.

次に、展示装置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 exhibition apparatus 100 will be described.
FIG. 4 is a control block diagram of the exhibition apparatus 100.
As shown in FIG. 4, the control unit of the exhibition apparatus 100 includes a target inclination angle generation unit 60 that generates a target inclination angle of the target flat plate 12 from a preset target trajectory, and a target sphere 10 from the target trajectory. And a target speed generation unit 62 for generating the target speed.
The target trajectory is expressed by the following equation (1), where the left-right direction of the plane of the flat plate 12 is the x-axis, the front-rear direction is the y-axis, the x coordinate of the sphere 10 on the flat plate 12 is x, y , (2).

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 sphere 10 is started from the initial position (x, y) = (0, 0) with zero speed and acceleration, the target trajectory is expressed by the following equations (3) and (4). Can be represented.

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 inclination angle generator 60 calculates target inclination angles θxo and θyo from the target trajectories x and y. The equation of motion in which the sphere 10 rolls on the plane of the flat plate 12 can be approximated by the following equation (5).

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 target speed generator 62 calculates the target speeds Vxo and Vyo from the target trajectories x and y by the following equations (8) and (9).

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 exhibition apparatus 100 further calculates the ball center position calculation unit 64 that calculates the center position of the sphere 10 on the flat plate 12 based on the detection results of the position sensors 24a and 24b, and the ball center position calculation unit 64. A ball position observer 66 that calculates the center position and speed of the sphere 10 on the flat plate 12 based on the center position of the sphere 10, and sensor motors 22 a and 22 b based on the center position of the sphere 10 calculated by the ball position observer 66. And a sensor motor rotation angle generation unit 68 for generating the rotation angle of the motor.

玉中心位置算出部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 position calculation unit 64 inputs motor angles MS1 and MS2 indicating rotation angles of the rotation shafts of the sensor motors 22a and 22b from the sensor motors 22a and 22b, and the distance L1 to the sphere 10 measured by the position sensors 24a and 24b. , L2 are input from the position sensors 24a, 24b, and the center positions Xc, Yc of the sphere 10 on the flat plate 12 are calculated based on the input motor angles MS1, MS2 and distances L1, L2. Since the arrangement relationship between the sensor motors 22a and 22b and the position sensors 24a and 24b and the diameter of the sphere 10 are known, the geometric calculation is performed from the input values from the sensor motors 22a and 22b and the position sensors 24a and 24b and the known values. Thus, the center positions Xc and Yc of the sphere 10 can be calculated.

玉位置オブザーバ部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 position observer unit 66 inputs the center positions Xc and Yc of the sphere 10 from the ball center position calculation unit 64 and uses the motor angles Z1 and Z2 indicating the rotation angle of the rotation axis of the ball screw motor 30 as the ball of each movable shaft 18. Based on the input center position Xc and Yc of the sphere 10 and motor angles Z1 and Z2, the center positions Xc_e and Yc_e and the speeds VXc_e and VYc_e of the sphere 10 on the flat plate 12 are calculated.

光沢のある曲面を有する球体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 sphere 10 having a glossy curved surface is measured by the position sensors 24a and 24b, noise and large errors are likely to occur. That is, the position and speed of the sphere 10 directly calculated from the distances L1 and L2 cannot be used for control. The target position of the target sphere 10 can be calculated from the inclination of the flat plate 12 calculated from the motor angles Z1 and Z2 and the equation of motion of the above equation (5). Then, the target position of the sphere 10 and the center positions Xc, Yc are compared to form an observer, and the center positions Xc_e, Yc_e and velocity VXc_e, which can be used for control by removing high-frequency noise and large measurement errors of the position sensors 24a, 24b, VYc_e is calculated.

センサモータ回転角生成部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 angle generation unit 68 inputs the center positions Xc_e and Yc_e of the sphere 10 from the ball position observer unit 66, and inputs target speeds Vxo and Vyo that are delay correction speed signals from the target speed generation unit 62, and inputs them. Based on the center positions Xc_e and Yc_e of the sphere 10 and the target speeds Vxo and Vyo, motor angle commands MS1r and MS2r for instructing the rotation angles of the rotation axes of the sensor motors 22a and 22b are generated, and the generated motor angle commands MS1r, MS2r is output to sensor motors 22a and 22b.

センサモータ回転角生成部68は、位置センサ24a、24bのレーザを、平板12上を転動する球体10の中心に向けるためセンサモータ22a、22bを駆動する。しかし、球体10の中心にレーザを向けると、レーザ光源が球体10に正反射し測定が乱れるため、球体10の中心から少しオフセットした位置を狙うことが好ましい。さらに、センサモータ22a、22bの応答の遅れを見込み、目標速度Vxo、Vyoをもとに、センサモータ22a、22bの狙い角を少し球体10の進行方向前方に定める。つまり、球体10の速度が速ければ速いほど、遅れ補正のゲインが大きくなるので、遅いときの行き過ぎを無くすために進行方向前方に定める。これにより、トラッキング性能を向上することができる。   The sensor motor rotation angle generator 68 drives the sensor motors 22a and 22b to direct the lasers of the position sensors 24a and 24b toward the center of the sphere 10 rolling on the flat plate 12. However, when the laser is directed to the center of the sphere 10, the laser light source is regularly reflected on the sphere 10 and the measurement is disturbed. Therefore, it is preferable to aim at a position slightly offset from the center of the sphere 10. Further, expecting a delay in response of the sensor motors 22a and 22b, the target angles of the sensor motors 22a and 22b are set slightly forward in the traveling direction of the sphere 10 based on the target speeds Vxo and Vyo. In other words, the higher the speed of the sphere 10 is, the larger the delay correction gain becomes. Therefore, in order to eliminate overshooting at a slow time, it is determined forward in the traveling direction. Thereby, tracking performance can be improved.

展示装置100の制御部は、さらに、目標速度生成部62から入力した目標速度Vxo、Vyoと玉位置オブザーバ部66から入力した球体10の速度VXc_e、VYc_eの差分を演算する減算部70と、減算部70の演算結果に所定の速度ゲインKvを乗算するゲイン部72と、目標傾斜角生成部60から入力した目標傾斜角度θxo、θyoとゲイン部72の演算結果を加算する加算部74とを有して構成されている。   The control unit of the exhibition apparatus 100 further includes a subtraction unit 70 that calculates a difference between the target speeds Vxo and Vyo input from the target speed generation unit 62 and the speeds VXc_e and VYc_e of the sphere 10 input from the ball position observer unit 66. A gain unit 72 that multiplies the calculation result of the unit 70 by a predetermined speed gain Kv; and an addition unit 74 that adds the target inclination angles θxo and θyo input from the target inclination angle generation unit 60 and the calculation result of the gain unit 72. Configured.

展示装置100の制御部は、さらに、目標軌道x、yと玉位置オブザーバ部66から入力した球体10の中心位置Xc_e、Yc_eの差分を演算する減算部76と、減算部76の演算結果に所定の位置ゲインKpを乗算するゲイン部78と、加算部74の演算結果とゲイン部78の演算結果を加算してその演算結果を傾斜角度指令θx、θyとして出力する加算部80とを有して構成されている。   The control unit of the exhibition apparatus 100 further calculates a difference between the target trajectory x, y and the center position Xc_e, Yc_e of the sphere 10 input from the ball position observer unit 66, and the calculation result of the subtraction unit 76 is predetermined. A gain unit 78 for multiplying the position gain Kp, and an addition unit 80 for adding the calculation result of the addition unit 74 and the calculation result of the gain unit 78 and outputting the calculation result as tilt angle commands θx and θy. It is configured.

展示装置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 exhibition apparatus 100 further includes a ball screw motor rotation angle generation unit 82 that generates motor angle commands Z1r and Z2r for instructing the rotation angle of the rotation axis of the ball screw motor 30 based on the calculation result of the addition unit 80. It is configured.
The ball screw motor rotation angle generation unit 82 inputs the tilt angle commands θx and θy from the addition unit 80, and inputs them by a linear approximation with a three-point support positional relationship between the support shaft 16 and the two movable shafts 18 and a small tilt. The height (rotation angle) of the ball screw 36 is calculated as the motor angle commands Z1r and Z2r from the tilt angle commands θx and θy. The motor angle commands Z1r and Z2r can be calculated by the following equations (10) and (11).

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 rotation angle generator 82 outputs motor angle commands Z1r and Z2r to the ball screw motor 30 of each movable shaft 18.
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 sphere 10 is started from the initial position (x, y) = (0, 0) with zero speed and acceleration, the target inclination angle The generation unit 60 calculates target inclination angles θxo and θyo from the target trajectories x and y, and the target speed generation unit 62 calculates target speeds Vxo and Vyo from the target trajectories x and y.

次いで、位置センサ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 sphere 10 on the flat plate 12 is detected by the position sensors 24a and 24b. Then, the ball center position calculation unit 64 calculates the center positions Xc and Yc of the sphere 10 on the flat plate 12 based on the detection results of the position sensors 24a and 24b, and the ball position observer unit 66 calculates the calculated sphere 10 Based on the center positions Xc and Yc, the center positions Xc_e and Yc_e and the velocities VXc_e and VYc_e of the sphere 10 on the flat plate 12 are calculated.

次いで、減算部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 sphere 10 is calculated by the subtracting unit 70, the difference value is multiplied by the speed gain Kv by the gain unit 72, and the target inclination angle is calculated by the adding unit 74. The calculation results of θxo and θyo and the gain unit 72 are added. Further, the subtractor 76 calculates the difference between the target trajectory x, y and the center position Xc_e, Yc_e of the sphere 10, the gain unit 78 multiplies the difference value by the position gain Kp, and the adder 80 adds the adder The calculation result of 74 and the calculation result of the gain unit 78 are added.

そして、ボールねじモータ回転角生成部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 angle generation unit 82 generates motor angle commands Z1r and Z2r from the tilt angle commands θx and θy from the addition unit 80, and the generated motor angle commands Z1r and Z2r are the balls of the movable shafts 18. It is output to the screw motor 30. As a result, the rotation of the ball screw motor 30 causes the movable shaft 18 to move up and down, and the inclination of the flat plate 12 is adjusted so that the sphere 10 rolls on the flat plate 12 along the target trajectories x and y. Accordingly, the sphere 10 rolls on the flat plate 12 along the target trajectories x and y.

一方、センサモータ回転角生成部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 angle generation unit 68 generates motor angle commands MS1r and MS2r from the center positions Xc_e and Yc_e of the sphere 10 and the target speeds Vxo and Vyo, and the generated motor angle commands MS1r and MS2r are converted into the sensor motor 22a, To 22b. As a result, the position sensors 24a and 24b are rotated by the sensor motors 22a and 22b so that the sphere 10 on the flat plate 12 belongs to the measurement region of the position sensors 24a and 24b.

このようにして、本実施の形態では、球体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 flat plate 12 having a plane on which the sphere 10 rolls, the base 14, the support shaft 16 that is installed between the flat plate 12 and the base 14 and supports one point on the lower surface of the flat plate 12. Two movable shafts 18 that are installed between the flat plate 12 and the base 14 and independently move up and down two points on the lower surface of the flat plate 12, and position sensors 24a and 24b that detect the position of the sphere 10 on the flat plate 12. And a control unit that controls the movable shaft 18 so that the sphere 10 rolls on the flat plate 12 along the target trajectories x and y based on the detection results of the position sensors 24a and 24b.

これにより、目標軌道x、yに沿って平板12上で球体10が転動するので、球体10が不規則な軌跡ではなく所定の軌跡を描くこととなり、従来に比して、高い展示効果を実現することができる。
さらに、本実施の形態では、平板12に固定されたセンサ取付板20a、20bを備え、位置センサ24a、24bは、センサ取付板20a、20bに設けられている。
Thereby, since the sphere 10 rolls on the flat plate 12 along the target trajectories x and y, the sphere 10 draws a predetermined trajectory instead of an irregular trajectory, and a higher display effect than in the past. Can be realized.
Further, in the present embodiment, sensor mounting plates 20a and 20b fixed to the flat plate 12 are provided, and the position sensors 24a and 24b are provided on the sensor mounting plates 20a and 20b.

これにより、平板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 position sensors 24a and 24b with respect to the plane of the flat plate 12 is fixed, the position of the sphere 10 on the flat plate 12 can be accurately detected regardless of the inclination angle of the flat plate 12.
Furthermore, in this embodiment, the flat plate 12 is based on the detection results of the sensor motors 22a and 22b that rotate the position sensors 24a and 24b around the axis in the direction orthogonal to the surface direction of the flat plate 12 and the position sensors 24a and 24b. And a controller that controls the sensor motors 22a and 22b so that the upper sphere 10 belongs to the measurement region of the position sensors 24a and 24b.

これにより、平板12上の球体10の位置にかかわらず、平板12上の球体10が位置センサ24a、24bの測定領域に属することとなるので、平板12上の球体10の位置を精度よく検出することができる。
さらに、本実施の形態では、平板12の下面と支持軸16および可動軸18をボールジョイントを介して接続した。
Accordingly, the sphere 10 on the flat plate 12 belongs to the measurement area of the position sensors 24a and 24b regardless of the position of the sphere 10 on the flat plate 12, and thus the position of the sphere 10 on the flat plate 12 is detected with high accuracy. be able to.
Furthermore, in the present embodiment, the lower surface of the flat plate 12 is connected to the support shaft 16 and the movable shaft 18 via a ball joint.

これにより、平板12の傾斜角の変化に追従して平板12を支持することができる。
上記第1の実施の形態において、支持軸16および可動軸18は、発明1または2の傾斜調整手段に対応し、展示装置100の制御部は、発明1の傾斜制御手段、または発明4の回転制御手段に対応し、センサ取付板20a、20bは、発明3のセンサ取付部材に対応している。また、センサモータ22a、22bは、発明4のセンサ回転手段に対応している。
Thereby, the flat plate 12 can be supported following the change in the inclination angle of the flat plate 12.
In the first embodiment, the support shaft 16 and the movable shaft 18 correspond to the tilt adjusting means of the invention 1 or 2, and the control unit of the display apparatus 100 is the tilt control means of the invention 1 or the rotation of the invention 4. Corresponding to the control means, the sensor mounting plates 20a, 20b correspond to the sensor mounting member of the third aspect. The sensor motors 22a and 22b correspond to the sensor rotating means of the fourth aspect.

〔第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 exhibition apparatus 100 in the first embodiment, the sphere 10 is moved along the target trajectories x and y without considering the initial position of the flat plate 12 in particular. In this embodiment, before the sphere 10 is moved, control for positioning the flat plate 12 in the horizontal position is performed.

まず、本実施の形態の展示装置100の構成を説明する。
本実施の形態の展示装置100は、図示しないが、上記第1の実施の形態の展示装置100に追加する形で、各可動軸18のボールねじ36の移動と共に同方向に移動するセンサ検出子200(例えば、ドグなど)と、ボールねじ36が平板12を水平とする位置に移動したときに、各センサ検出子200を検出するフォトセンサ26(例えば、フォトリフレクタ、フォトインタラプタなど)とを備えた構成となっている。
First, the structure of the exhibition apparatus 100 of this Embodiment is demonstrated.
Although not shown, the display device 100 of the present embodiment is a sensor detector that moves in the same direction as the ball screw 36 of each movable shaft 18 moves in addition to the display device 100 of the first embodiment. 200 (for example, a dog) and a photo sensor 26 (for example, a photo reflector, a photo interrupter, etc.) for detecting each sensor detector 200 when the ball screw 36 moves to a position where the flat plate 12 is horizontal. It becomes the composition.

次に、図5に基づき、本実施の形態の展示装置100の制御部の構成を説明する。
ここで、図5は、本実施の形態の展示装置100の制御部の構成を示すブロック図である。
図5に示すように、本実施の形態の展示装置100の制御部は、ボールねじモータ30の回転角度位置を検出する位置検出器として、各ボールねじモータ30がインクリメンタル型のロータリエンコーダを有する。
Next, based on FIG. 5, the structure of the control part of the exhibition apparatus 100 of this Embodiment is demonstrated.
Here, FIG. 5 is a block diagram showing the configuration of the control unit of the exhibition apparatus 100 of the present embodiment.
As shown in FIG. 5, the control unit of the exhibition apparatus 100 according to the present embodiment has each ball screw motor 30 having an incremental rotary encoder as a position detector that detects the rotational angle position of the ball screw motor 30.

本実施の形態の制御部は、更に、上記第1の実施の形態の展示装置100の制御部に追加する形で、平板12の水平位置決めを行う水平位置決め部84を含んだ構成となっている。本実施の形態では、この水平位置決め部84によって、球体10を目標軌道x、yに沿って移動させる前に(展示を行う前に)、平板12の水平位置決めを行うことが可能である。   The control unit according to the present embodiment further includes a horizontal positioning unit 84 that performs horizontal positioning of the flat plate 12 in addition to the control unit of the display device 100 according to the first embodiment. . In the present embodiment, the horizontal positioning unit 84 can perform the horizontal positioning of the flat plate 12 before moving the sphere 10 along the target trajectories x and y (before exhibiting).

水平位置決め部84は、ユーザの操作部の操作や展示装置100の電源オンなどを契機に発せられる水平位置決め指令に応じて動作を開始し、フォトセンサ26の検出結果及びボールねじモータ30のロータリエンコーダの検出結果などに基づき、予め決められた手順でボールねじ36を上下動させる制御を行い、平板12の水平位置決めを行う。
より具体的に、水平位置決め部84は、水平位置決め指令を受けると、ボールねじ回転角生成部82に対して、以下の(1)〜(4)の手順でモータ角度指令Z1r、Z2rを出力し、ボールねじ36を上下動させて、平板12の水平位置決め処理を行う。なお、以下の(1)〜(4)の処理は、各可動軸18のボールねじ36に対して行われる。
The horizontal positioning unit 84 starts to operate in response to a horizontal positioning command issued when the user operates the operation unit or the display device 100 is turned on. The detection result of the photosensor 26 and the rotary encoder of the ball screw motor 30 are started. Based on the detection result, the ball screw 36 is controlled to move up and down in a predetermined procedure, and the flat plate 12 is positioned horizontally.
More specifically, when receiving a horizontal positioning command, the horizontal positioning unit 84 outputs motor angle commands Z1r and Z2r to the ball screw rotation angle generating unit 82 in the following procedures (1) to (4). Then, the ball screw 36 is moved up and down to perform horizontal positioning processing of the flat plate 12. The following processes (1) to (4) are performed on the ball screw 36 of each movable shaft 18.

ここで、図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 flat plate 12 executed in the horizontal positioning unit 84.
(1) As shown in FIG. 6, a motor angle command is generated from the operation start point so that the ball screw 36 moves at a predetermined speed in a direction in which the flat plate 12 becomes horizontal, and is output to the ball screw motor 30. Further, when the Z-phase is first detected by the rotary encoder after the ball screw 36 has moved, a motor angle command is generated so that the ball screw 36 stops at the detected position and is output to the ball screw motor 30. At this time, a reset command for resetting the count value of the position detection pulse is given to the rotary encoder of the ball screw motor 30. Thereby, the count value of the position detecting pulse of the rotary encoder is reset at the position where the Z phase is detected.

(2)上記(1)の停止位置(Z相の検出位置)から、平板12の平面が水平方向となる方向にボールねじ36が所定速度で移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、ボールねじ36が移動後に、フォトセンサ26でセンサ検出子200が検出されたると、その検出位置でボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。 (2) A motor angle command is generated so that the ball screw 36 moves at a predetermined speed in the direction in which the flat surface of the flat plate 12 is in the horizontal direction from the stop position (Z-phase detection position) in (1) above. Output to the screw motor 30. Further, when the sensor detector 200 is detected by the photosensor 26 after the ball screw 36 has moved, a motor angle command is generated so that the ball screw 36 stops at the detected position and is output to the ball screw motor 30.

(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 ball screw 36 moves at a predetermined speed in the direction opposite to the moving direction in (2), and is output to the ball screw motor 30. To do. Further, when the Z-phase is first detected by the rotary encoder after the ball screw 36 has moved, a motor angle command is generated so that the ball screw 36 stops at the detected position and is output to the ball screw motor 30.

(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 ball screw 36 by a moving distance d 0 where becomes a horizontal position, and is output to the ball screw motor 30. Thereby, the ball screw 36 moves toward the horizontal position with the same position accuracy as the resolution of the encoder, and stops (positioned horizontally) at the position detected as the horizontal position.

次に、本実施の形態の動作を説明する。
ユーザによる操作部の操作によって、水平位置決め指令が水平位置決め部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 horizontal positioning unit 84 by the operation of the operation unit by the user, the horizontal positioning unit 84 starts the horizontal positioning process of the flat plate 12.
The horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 of each movable shaft 18 moves from its initial position in a direction in which the position of the ball screw 36 approaches the flat plate 12 in the horizontal direction, and the ball screw motor Output to 30. Thereby, the ball screw motor 30 is driven, and the ball screw 36 moves in a direction to bring the flat plate 12 closer to the horizontal direction.

一方、ボールねじモータ30が駆動すると、ボールねじモータ30のロータリエンコーダは、内部のフォトセンサと、スリット機構とによってモータの回転に伴って発生するパルスをカウントし、ボールねじモータ30の(ボールねじ36)の回転角度位置の検出を行う。そして、ボールねじモータ30の駆動に伴って、ロータリエンコーダの回転子が回転すると、やがてロータリエンコーダにおいてZ相が検出される。   On the other hand, when the ball screw motor 30 is driven, the rotary encoder of the ball screw motor 30 counts pulses generated as the motor rotates by the internal photo sensor and the slit mechanism, and the ball screw motor 30 (ball screw motor 30 The rotation angle position of 36) is detected. When the rotor of the rotary encoder rotates as the ball screw motor 30 is driven, the Z phase is detected in the rotary encoder.

水平位置決め部84は、ロータリエンコーダにおいてZ相が検出されると、その検出位置においてボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。更に、Z相の検出位置において、ロータリエンコーダにパルスのカウント値をリセットするようにリセット指令を与える。これによって、リセット指令を受けたボールねじモータ30のロータリエンコーダは、パルスのカウント値をリセットする。   When the Z phase is detected by the rotary encoder, the horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 stops at the detected position, and outputs the motor angle command to the ball screw motor 30. Further, at the Z-phase detection position, a reset command is given to the rotary encoder so as to reset the pulse count value. Accordingly, the rotary encoder of the ball screw motor 30 that has received the reset command resets the pulse count value.

水平位置決め部84は、ロータリエンコーダにおいて、パルスのカウント値がリセットされると、これまでの移動方向と同じ方向に、可動軸18のボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が駆動し、ボールねじ36が平板12を水平方向に近づける方向に更に移動する。このとき、ボールねじ36の移動に伴ってセンサ検出子200も移動し、やがてフォトセンサ26において、センサ検出子200が検出される。   When the pulse count value is reset in the rotary encoder, the horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 of the movable shaft 18 moves in the same direction as the previous movement direction, Output to the ball screw motor 30. As a result, the ball screw motor 30 is driven, and the ball screw 36 further moves in a direction to bring the flat plate 12 closer to the horizontal direction. At this time, the sensor detector 200 also moves with the movement of the ball screw 36, and eventually the sensor detector 200 is detected by the photosensor 26.

水平位置決め部84は、フォトセンサ26において、センサ検出子200が検出されると、その検出位置において、ボールねじ36が停止するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が停止し(またはブレーキをかけた状態になり)、ボールねじ36がセンサ検出子200の検出位置において停止する。   When the sensor detector 200 is detected in the photosensor 26, the horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 stops at the detection position, and outputs the motor angle command to the ball screw motor 30. As a result, the ball screw motor 30 stops (or enters a braked state), and the ball screw 36 stops at the detection position of the sensor detector 200.

水平位置決め部84は、ボールねじ36がセンサ検出子200の検出位置において停止すると、今度は、これまでの移動方向とは逆方向にボールねじ36が移動するようにモータ角度指令を生成して、ボールねじモータ30に出力する。これによって、ボールねじモータ30が逆回転に駆動し、ボールねじ36がこれまでとは逆方向に移動する。例えば、これまで上方向に移動していた場合は、下方向に移動する。   When the ball screw 36 stops at the detection position of the sensor detector 200, the horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 moves in a direction opposite to the moving direction so far. Output to the ball screw motor 30. As a result, the ball screw motor 30 is driven in the reverse rotation, and the ball screw 36 moves in the reverse direction. For example, if it has been moved upward, it moves downward.

この移動によって、ロータリエンコーダにおいて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 horizontal positioning unit 84 generates a motor angle command so that the ball screw 36 stops at the first detected Z phase position, Output to the ball screw motor 30. As a result, the ball screw 36 stops at the position where the Z phase is first detected after moving in the reverse direction.
Further, when the ball screw 36 stops at the position where the Z phase is first detected, the horizontal positioning unit 84 starts from the stop position measured in advance with a level or the like in the same movement direction as when the Z phase was detected. A motor angle command is generated so that the ball screw 36 moves by a moving distance d 0 to a position where the flat surface of the flat plate 12 is horizontal, and is output to the ball screw motor 30. As a result, the ball screw motor 30 is driven, and the ball screw 36 is moved and stopped in the direction in which the flat plate 12 is horizontal by a distance d 0 from the stop position based on the position detected by the rotary encoder of the ball screw motor 30. . Thereby, the horizontal positioning of the flat plate 12 is completed.

以降は、平板12上に球体10を乗せて、上記第1の実施の形態と同様に、目標軌道x、yに沿って球体10を移動させる制御が行われる。
このようにして、本実施の形態では、水平位置決め部84において、上記(1)〜(4)の手順でボールねじ36を移動させ、且つロータリエンコーダのパルスカウント値のリセットを行わせる制御を行って、平板12の水平位置決めを行うことがが可能である。
Thereafter, the control is performed such that the sphere 10 is placed on the flat plate 12 and the sphere 10 is moved along the target trajectories x and y as in the first embodiment.
In this manner, in the present embodiment, the horizontal positioning unit 84 performs control to move the ball screw 36 according to the procedures (1) to (4) and reset the pulse count value of the rotary encoder. Thus, the horizontal positioning of the flat plate 12 can be performed.

これにより、ボールねじ36の初期位置(動作開始点)によらずに、ボールねじモータ30の有するロータリエンコーダの位置検出精度で、平板12の水平位置決めを行うことができる。
上記第2の実施の形態において、支持軸16および可動軸18は、発明5の支持軸および可動軸に対応し、展示装置100の制御部は、発明5の傾斜制御手段に対応し、ボールねじモータ30は、発明5のアクチュエータおよびエンコーダに対応する。
Thereby, the horizontal positioning of the flat plate 12 can be performed with the position detection accuracy of the rotary encoder of the ball screw motor 30 regardless of the initial position (operation start point) of the ball screw 36.
In the second embodiment, the support shaft 16 and the movable shaft 18 correspond to the support shaft and the movable shaft of the invention 5, and the control unit of the display apparatus 100 corresponds to the inclination control means of the invention 5, and the ball screw. The motor 30 corresponds to the actuator and encoder of the fifth aspect.

なお、上記第1及び第2の実施の形態においては、平板12の平面の形状を矩形としたが、これに限らず、円形、楕円形その他の形状とすることもできる。
また、上記第1及び第2の実施の形態において、展示装置100は、1つの球体10を平板12上で転動させるように構成したが、これに限らず、2以上の球体10を平板12上で転動させるように構成することもできる。
In the first and second embodiments, the flat shape of the flat plate 12 is rectangular. However, the shape is not limited to this, and may be circular, elliptical, or other shapes.
Moreover, in the said 1st and 2nd embodiment, although the display apparatus 100 was comprised so that the one spherical body 10 might roll on the flat plate 12, it is not restricted to this, Two or more spherical bodies 10 are made into the flat plate 12. FIG. It can also be configured to roll above.

また、上記第1及び第2の実施の形態において、あらかじめ設定された所定の円軌道に沿って平板12上で球体10を転動させる構成としたが、これに限らず、数式で表現可能な任意の軌道の組み合わせよりなる軌道に沿って平板12上で球体10を転動させる構成としてもよい。但し、この構成の場合は、各軌道を表す数式同士が3階微分まで連続である必要がある。   Moreover, in the said 1st and 2nd embodiment, it was set as the structure which rolls the spherical body 10 on the flat plate 12 along the predetermined circular orbit set beforehand, but it is not restricted to this, It can express with numerical formula. It is good also as a structure which rolls the spherical body 10 on the flat plate 12 along the track | orbit which consists of arbitrary track | orbit combinations. However, in the case of this configuration, the mathematical expressions representing the respective trajectories need to be continuous up to the third order differentiation.

また、上記第1及び第2の実施の形態において、センサモータ22a、22bの位置を既知として、これらの取付け誤差を特に考慮せずに幾何学計算を行う構成としたが、幾何学計算を行う前に、取付け誤差を考慮したキャリブレーションを行う構成としてもよい。
このキャリブレーションは、例えば、以下の(A)〜(D)の手順で行う。
In the first and second embodiments, the positions of the sensor motors 22a and 22b are known, and the geometric calculation is performed without particularly considering these mounting errors. However, the geometric calculation is performed. It is good also as a structure which performs the calibration which considered the attachment error before.
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 flat plate 12, two lasers are applied to the edge, and the values and distances of the high-precision angle sensors of the sensor motors 22a and 22b at that time are recorded.
(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 sensor motors 22a and 22b.
(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 display apparatus 100 determines the center positions Xc and Yc of the sphere 10 on the flat plate 12 without considering the measurement distance error of the position sensors 24a and 24b due to noise. However, the present invention is not limited to this, and a configuration may be adopted in which the measurement distance is filtered before the center positions Xc and Yc of the sphere 10 are calculated to reduce errors caused by noise.

例えば、図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 display device 100 is replaced with the control unit of the display device 100 of FIG. 4 in the above embodiment based on the ball center position from the ball position observer unit 66. The distance processing unit 90 for performing the filtering process of the measured distance based on the distance measured by the position sensors 24a and 24b and the distance calculated by the distance back calculating unit 90. And added.

このような構成であれば、制御部は、玉中心位置算出部64において、平板12上の球体10の中心位置を算出する際に、まず、距離逆算部90において、玉位置オブザーバ部66において推定された球体10の推定位置から、位置センサ24a、24bにおいて測定されるべき距離を幾何学的に逆算する。
次に、フィルタリング処理部92において、位置センサ24aに対して逆算された距離Le(以下、逆算距離Le1と称す)と位置センサ24aで測定された距離L(L1)との差分の絶対値を算出し、該算出した差分の絶対値と予め設定された閾値Lthとを比較する。
With this configuration, when the ball center position calculation unit 64 calculates the center position of the sphere 10 on the flat plate 12, the control unit first estimates the ball position observer unit 66 in the distance back calculation unit 90. The distance to be measured by the position sensors 24a and 24b is geometrically calculated from the estimated position of the sphere 10 thus obtained.
Next, the filtering processing unit 92 calculates the absolute value of the difference between the distance Le calculated backward with respect to the position sensor 24a (hereinafter referred to as the reverse calculation distance Le1) and the distance L (L1) measured by the position sensor 24a. Then, the absolute value of the calculated difference is compared with a preset threshold value Lth.

そして、下式(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 position sensor 24a has been correctly performed. On the other hand, as shown in the following equation (13), when the absolute value of the difference is larger than the threshold value Lth, it is determined that the distance measurement of the position sensor 24a has not been performed correctly.

| 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 filtering processing unit 92 calculates the absolute value of the difference between the reverse calculation distance Le (hereinafter referred to as reverse calculation distance Le2) for the position sensor 24b and the measurement distance L (L2) measured by the position sensor 24b. The absolute value is compared with the threshold value Lth. Then, as shown in the above equation (12), when the absolute value of the difference is equal to or smaller than the threshold value Lth, it is determined that the distance measurement of the position sensor 24b has been performed correctly. On the other hand, as shown in the above equation (13), when the absolute value of the difference is larger than the threshold value Lth, it is determined that the distance measurement of the position sensor 24b has not been performed correctly.

次に、フィルタリング処理部92、94において、距離測定が正しく行われたと判定された場合は、下式(14)に示すように、玉中心位置算出部64に出力する距離Lout t(以下、出力距離Lout tと称す)をLtとする。
一方、フィルタリング処理部92、94において、距離測定が正しく行われなかったと判定された場合は、下式(15)に示すように、前回の(1サイクル前の)測定距離Lt-1に、逆算距離Leの微分Le´に1サイクル時間tを乗算した「Le´×t」を加算した値を出力距離Lout tとする。

out t=Lt …(14)
out t=Lt-1+Le´×t …(15)

このように、位置センサ24a、24bの測定距離に対してフィルタリング処理を行うことで、ノイズによる大きな測定誤差や、短時間の測定エラーに対してもトラッキングを続行することができる。
Next, when it is determined in the filtering processing units 92 and 94 that the distance measurement has been performed correctly, as shown in the following equation (14), the distance L out t (hereinafter, referred to as “ball center position calculation unit 64”) to be output to the ball center position calculation unit 64 The output distance L out t ) is defined as L t .
On the other hand, when the filtering processing units 92 and 94 determine that the distance measurement has not been performed correctly, as shown in the following equation (15), the previous measurement distance L t-1 (one cycle before) is A value obtained by adding “Le ′ × t” obtained by multiplying the differential Le ′ of the reverse calculation distance Le by one cycle time t is defined as an output distance L out t .

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 position sensors 24a and 24b, tracking can be continued even for a large measurement error due to noise or a short-time measurement error.

また、上記第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 exhibition apparatus 100 uses the addition unit 74 to calculate the target inclination angles θxo and θyo input from the target inclination angle generation unit 60 and the calculation result of the gain unit 72. And the addition unit 80 adds the calculation result of the addition unit 74 and the calculation result of the gain unit 78 and outputs the calculation result as tilt angle commands θx and θy. In this configuration, the error of the distance measured by the laser is taken into consideration (even if the observer is used, the error of the laser is taken into consideration), and θxo and θyo generated from the target trajectory are calculated when the tilt angle commands θx and θy are calculated. The contribution may be increased and the feedback gain may be reduced as much as possible. As a result, the stability of control can be improved.

また、上記第1及び第2の実施の形態において、ゲイン部72により、球体10の速度VXc_e、VYc_eの差分値に速度ゲインKvを乗算するようにしたが、速度ゲインKvは、目標速度のノルムVo(=(VXc_e2+VYc_e21/2)に依存するため、図8に示すように、低速時において(又は停止時において)は、ゲインKvが小さくなるように制御する構成にしてもよい。これによって、球体10が停止、又は低速移動時に制御を安定させることが可能となる。ここで、図8は、速度ゲインKvと目標速度のノルムVoとの関係を示す図である。 In the first and second embodiments, the gain unit 72 multiplies the difference value between the speeds VXc_e and VYc_e of the sphere 10 by the speed gain Kv. The speed gain Kv is the norm of the target speed. Since it depends on Vo (= (VXc_e 2 + VYc_e 2 ) 1/2 ), as shown in FIG. 8, the gain Kv may be controlled to be small at low speed (or at stop). . This makes it possible to stabilize the control when the sphere 10 stops or moves at a low speed. Here, FIG. 8 is a diagram showing the relationship between the speed gain Kv and the norm Vo of the target speed.

また、上記第1及び第2の実施の形態において、ボールねじモータ回転角生成部82により、モータ角度指令Z1r、Z2rを生成し、生成されたモータ角度指令Z1r、Z2rを各可動軸18のボールねじモータ30に出力して、目標軌道x、yに沿って平板12上で球体10が転動するように平板12の傾斜を調整する制御を行うようにしたが、この制御ループにおいて、バックラッシュを除去する制御を組み込むようにしてもよい。これによって、制御の精度を向上することが可能となる。   In the first and second embodiments, the ball screw motor rotation angle generator 82 generates the motor angle commands Z1r and Z2r, and the generated motor angle commands Z1r and Z2r are used for the balls of the movable shafts 18. The control is performed so that the inclination of the flat plate 12 is adjusted so that the sphere 10 rolls on the flat plate 12 along the target trajectories x and y. You may make it incorporate the control which removes. As a result, the accuracy of control can be improved.

展示装置100の設置状態を示す図である。It is a figure which shows the installation state of the display apparatus. 展示装置100の外観構造を示す図である。FIG. 3 is a diagram showing an external structure of the exhibition apparatus 100. 可動軸18の外観構造を示す図である。FIG. 3 is a diagram showing an external structure of a movable shaft 18. 第1の実施の形態の展示装置100の制御ブロック図である。It is a control block diagram of the exhibition apparatus 100 of 1st Embodiment. 第2の実施の形態の展示装置100の制御ブロック図である。It is a control block diagram of the exhibition apparatus 100 of 2nd Embodiment. 水平位置決め処理の手順を示す図である。It is a figure which shows the procedure of a horizontal positioning process. 測定距離のフィルタリング処理を行う場合の展示装置100の制御ブロック図である。It is a control block diagram of the exhibition apparatus 100 in the case of performing the measurement distance filtering process. 速度ゲインKvと目標速度のノルムVoとの関係を示す図である。}It is a figure which shows the relationship between speed gain Kv and norm Vo of target speed. }

符号の説明Explanation of symbols

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 SYMBOLS 100 Exhibition apparatus 12 Flat plate 10 Sphere 14 Base 16 Support shaft 18 Movable shaft 20a, 20b Sensor mounting plate 22a, 22b Sensor motor 24a, 24b Position sensor 26 Photo sensor 30 Ball screw motor 32 Base 34 Back plate 38 Ball nut 40 Linear guide 42 Cylindrical member 44 Ball joint 46 Flat plate mounting head 60 Target inclination angle generation unit 62 Target speed generation unit 64 Ball center position calculation unit 66 Ball position observer unit 68 Sensor motor rotation angle generation unit 70, 76 Subtraction unit 72, 78 Gain unit 74 80 Adding unit 82 Ball screw motor rotation angle generating unit 84 Horizontal positioning unit 90 Distance back calculation unit 92, 94 Filtering processing unit

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.
請求項1において、
前記傾斜調整手段は、前記平板および固定面の間に設置され前記平板の下面の一点を支持する支持軸と、前記平板および前記固定面の間に設置され前記平板の下面の他点を上下動させる可動軸とを有することを特徴とする展示装置。
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.
請求項1および2のいずれか1項において、
さらに、前記平板に固定されたセンサ取付部材を備え、
前記位置センサは、前記センサ取付部材に設けられていることを特徴とする展示装置。
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.
請求項3において、
さらに、前記平板の面方向と直交する方向の軸回りに前記位置センサを回転させるセンサ回転手段と、前記位置センサの検出結果に基づいて、前記平板上の前記球体が前記位置センサの測定領域に属するように前記センサ回転手段を制御する回転制御手段とを備えることを特徴とする展示装置。
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.
JP2008157729A 2007-10-23 2008-06-17 Exhibition equipment Expired - Fee Related JP5167976B2 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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