傾斜角度センサ、および傾斜角度センサ装置
【課題】機械要素を用いずに傾斜角度に関する検出信号を出力する傾斜角度センサの提供を図る。
【解決手段】傾斜角度センサ５０は、送信部４と球形容器３と受信部５とを備える。送信部４は、鉛直方向からの傾斜角度θに応じた方向に超音波パルスを送信する。球形容器３は２種の不混和な油剤１，２が充填されている。超音波パルスは、油剤１，２の間の水平な界面６を通過する。受信部５は、超音波パルスを受信し検出信号を出力する。傾斜角度θに応じて、超音波パルスの油剤１，２における伝搬距離が変化し、超音波パルスの総伝搬時間が変化する。したがって、検出信号の、駆動信号の送信時間に対する遅延時間は、は、傾斜角度θに応じて変化する。
【解決手段】傾斜角度センサ５０は、送信部４と球形容器３と受信部５とを備える。送信部４は、鉛直方向からの傾斜角度θに応じた方向に超音波パルスを送信する。球形容器３は２種の不混和な油剤１，２が充填されている。超音波パルスは、油剤１，２の間の水平な界面６を通過する。受信部５は、超音波パルスを受信し検出信号を出力する。傾斜角度θに応じて、超音波パルスの油剤１，２における伝搬距離が変化し、超音波パルスの総伝搬時間が変化する。したがって、検出信号の、駆動信号の送信時間に対する遅延時間は、は、傾斜角度θに応じて変化する。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサと、傾斜角度センサの出力する受信信号に基づいて傾斜角度を取得する傾斜角度センサ装置とに関する。
【背景技術】
【０００２】
自機の鉛直方向からの傾斜に応じて移動するボールを備え、ボールの位置を検出することにより、自機の鉛直方向からの傾斜方向と傾斜角度とを検出するセンサが提案されている（例えば、特許文献１および２参照。）。
【特許文献１】特開平１１−２７３５１５号公報
【特許文献２】特開平９−２９２２１９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ボールのような機械要素を備えるセンサは物理的損傷が生じ易く耐用期間が短い。
【０００４】
そこで、本発明は機械要素を用いずに傾斜角度に関する検出信号を出力する傾斜角度センサと、傾斜角度センサの出力から傾斜角度を取得する傾斜角度センサ装置とを提供することを目的とする。
【課題を解決するための手段】
【０００５】
本発明の傾斜角度センサは、自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する。そのために傾斜角度センサは、送信手段と受信手段と位置保持手段とを備える。送信手段は、自機の姿勢の鉛直方向からの傾斜角度に応じた方向に送信波を送信する。受信手段は、送信波を受信した検出信号を出力する。位置保持手段は、送信手段から送信した送信波が２種の不混和流体の間の略水平な界面を通過して受信手段にて受信される位置に送信手段と受信手段とを保持する。２種の不混和流体とは、互いの不混和性の高い２種の液体や、液体と気体などである。
【０００６】
この構成では、不混和流体の界面が水平を維持することを利用して、界面を通過する送信波を変化させる。このため、送信波を受信して生成する検出信号が傾斜角度に応じて変容する。
【０００７】
位置保持手段として、各不混和流体が異なる容量で充填された球形容器または円筒状容器を用い、送信波が球形容器の中心または円筒状容器の中心軸に垂直な断面の中心を通過する位置に送信手段と受信手段とを保持すれば、各不混和流体にて傾斜角度に応じた伝搬距離で送信波が伝搬して受信手段にて受信される。そのため、検出信号は、各不混和流体での送信波の伝搬距離に応じて変容する。
【０００８】
送信波としての音波の距離当たりの伝搬時間、すなわち音速が各不混和流体で相違すると好適である。この場合、各不混和流体での送信波の伝搬距離によって各不混和流体を通過する総伝搬時間が定まり、伝搬距離に応じて検出信号が変容する。したがって、検出信号から総伝搬時間を把握することで、送信波が各不混和流体を伝搬する伝搬距離、ひいては自機の傾斜角度が把握可能になる。
【０００９】
傾斜角度センサ装置は、傾斜角度センサと傾斜角度取得部とを備え、傾斜角度センサの出力する検出信号に基づいて音波の総伝搬時間を算出し、傾斜角度を取得してもよい。この取得には、以下の式に相当する演算を用いることができる。
【００１０】
【数１】
【００１１】
ただし、傾斜角度θ、総伝搬時間T、音波の距離当たりの伝搬時間である音速U，V、球形容器の中心から界面までの距離である界面距離H、容器の円形断面の半径R、各不混和流体以外を音波が伝搬する時間ΔTである。
【発明の効果】
【００１２】
この発明の傾斜角度センサおよび傾斜角度センサ装置は、不混和流体の界面が水平を維持することを利用して、界面を通過する送信波を傾斜角度に応じて変化させる。これにより、不混和流体を伝搬する送信波が傾斜角度に応じて変容し、送信波を受信して傾斜角度に関する検出信号を出力できる。機械要素が必要ないので物理的損傷が生じ難く耐用期間が長い。
【発明を実施するための最良の形態】
【００１３】
以下、この発明の実施形態に係る傾斜角度センサを備える傾斜角度センサ装置の一例として、機構部の姿勢を制御する姿勢制御装置を説明する。
【００１４】
図１は姿勢制御装置の概略のブロック図である。
姿勢制御装置１００は、機構部６０と制御部９０とを備える。機構部６０は傾斜角度センサ５０を備え、制御部９０は機能的に駆動信号生成部７０と傾斜角度算出部８０を備え、機構部６０を制御する。機構部６０は制御部９０からの制御により自らの姿勢を変更する。駆動信号生成部７０は駆動信号を生成して、傾斜角度センサ５０と傾斜角度算出部８０とに出力する。傾斜角度センサ５０は駆動信号によって駆動し、機構部６０の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する。傾斜角度算出部８０は、駆動信号生成部７０が出力する駆動信号と傾斜角度センサ５０が出力する検出信号とに基づいて、機構部６０の姿勢の鉛直方向からの傾斜角度を算出する。制御部９０は、傾斜角度算出部８０の算出結果に基づいて機構部６０を制御する。
【００１５】
図２は傾斜角度センサ５０の概略の垂直断面図である。
【００１６】
傾斜角度センサ５０は、一例として油剤１，２と球形容器３と送信部４と受信部５とを備える。球形容器３は、油剤1と油剤２とが充填された球形の容器であり、機構部６０にともなって姿勢を変更する。油剤１と油剤２とはそれぞれ異なる容量で球形容器３に充填されている。油剤１と油剤２とは互いの不混和性が高く、互いの境界に水平な界面６が形成され、油剤２より比重が小さい油剤１が界面６の上方で層をなし、油剤２が界面６の下方で層をなす。また、油剤１と油剤２とは、それぞれにおける距離当たりの音波の伝搬速度、すなわち音速が相違する。
【００１７】
送信部４は、球形容器３の姿勢が鉛直方向を向く際の頂点の外側に設けられていて、球形容器３の形状中心に向けて音波を送信する圧電素子を備える。受信部５は、球形容器３の外側の送信部４と対向する位置に設けられ、球形容器３の形状中心の方向からの音波を受信する圧電素子を備える。
【００１８】
この傾斜角度センサ５０では、球形容器３の姿勢を傾斜させても界面６の位置は水平に維持されるが、送信部4及び受信部５は球形容器３の姿勢の傾斜に伴って傾斜する。これにより、送信部4から受信部５までの音波の伝搬経路における界面６の位置が変化し、各油剤１，２内での音波の伝播距離が変化する。このため球形容器３の姿勢が傾斜すると、各油剤１，２内での音波の伝播時間が変化し、送信部4から受信部５までの音波の総伝搬時間も変化する。
【００１９】
したがって、受信部５にて検出する音波の検出信号における音波波形は、送信部４の駆動信号における駆動波形よりも、総伝播時間だけ遅延したものになる。これにより、音波の検出信号から総伝搬時間を計測することができる。なお、送信部４を油剤１，２の界面近傍に配置すると、音波の全反射が生じることがあって、この場合、送信部４から送信された音波を受信部５にて受信できなくなる。このため、検出角度θが検出できなくなることがある。そこで、この傾斜角度センサ５０においては、想定される傾斜角度範囲において音波の全反射が生じないような条件となるように送信部４および受信部５の位置を予め決定しておく。
【００２０】
また、油剤１，２の特性としては、それぞれでの音速が大きく異なると好適であり、望ましくは一方の音速が他方の音速の１．２倍程度はあるとよい。音速の差が大きいほど、傾斜角度の変化に対する総伝搬時間の変化の感度が大きくなるためである。
【００２１】
図３は、送信部４の駆動信号と、受信部５が出力する検出信号との関係を説明する図である。図中の（Ａ）は送信部４の駆動信号の電圧の時間変化の一例を示すグラフであり、図中の（Ｂ）は受信部５の出力する検出信号の電圧の時間変化の一例を示すグラフである。
【００２２】
駆動信号生成部７０が、時刻ｔ０に立ち上がるパルス電圧を駆動信号として、傾斜角度センサ５０の送信部４と傾斜角度算出部８０とに出力すると、送信部４の振動子は発振し音波を送波する。この音波は、送信部４の振動子から、球形容器３の壁、油剤１、油剤２、球形容器３の壁を媒体として伝搬し、時刻t１にゼロクロスをとる検出信号として受信部５で受信される。受信部５は検出信号を傾斜角度算出部８０に出力する。後述する傾斜角度算出部８０の処理では、この時刻ｔ１を利用して傾斜角度を算出する。なお、検出信号のゼロクロス時刻ではなく立ち上がり時刻を時刻ｔ１として採用すれば、受信部５を構成する圧電素子のばらつきや、送信部４から送信される音波の周波数ばらつきの影響を受けて測定精度に問題が生じる虞がある。そのため、ここでは検出信号の立ち上がり時刻ではなくゼロクロス時刻を時刻ｔ１として採用することで、上述の虞をなくし、精度の高い信号検知を行うようにしている。
【００２３】
傾斜角度算出部８０は、時刻ｔ０から時刻ｔ１までの総伝搬時間Tを検出し、この時間Tに基づいて球形容器３の傾斜角度θを算出する。傾斜角度算出部８０における傾斜角度θの算出は、以下の算出式に総伝搬時間Tと、各種定数とを代入することにより行う。ここで、各不混和流体中での音速を定数U，Vとし、球形容器３の中心から界面６までの界面距離を定数Hとし、球形容器３の半径を定数Rとし、音波が球形容器３の壁を伝搬する時間を定数ΔTとする。
【００２４】
【数１】
【００２５】
この傾斜角度算出部８０の算出結果に基づいて、制御部９０は機構部６０の制御内容を決定し、機構部６０を制御する。
【００２６】
以上の構成により、本実施形態の姿勢制御装置１００は、機械要素を用いない傾斜角度センサ５０によって、傾斜角度に関する検出信号を取得し、その検出信号から傾斜角度を取得することができる。機械要素を用いていない傾斜角度センサ５０は、故障し難く耐用期間が長い。
【００２７】
この実施形態では傾斜角度算出部８０にて傾斜角度を算出する構成について説明したが、予め、総伝搬時間と傾斜角度との対応関係を記憶したテーブルを用意しておけば、算出式を用いなくても傾斜角度を取得できるので、このようなテーブルを備えていても良い。
【００２８】
次に、傾斜角度θの算出式の導出について説明する。
【００２９】
機構部６０および球形容器３が傾斜すると、送信部４の位置も傾斜する。傾斜角度θで送信部４の圧電素子が発振すると、超音波パルスが球形容器３の壁、油剤１、油剤２、球形容器３の壁を媒体として伝搬するが、超音波パルスが油剤１の層を伝搬する距離L1と、油剤２の層を伝搬する距離L2とが、傾斜角度θと容器半径Rと界面距離Hとに応じた次式で示す値となる。
【００３０】
【数２】
【００３１】
【数３】
【００３２】
各油剤層での音速は温度や圧力などの影響を除けば一定であるため、超音波パルスが油剤１を伝搬するのに要する時間T1は傾斜角度θと音速Uとに応じて次式で示すように変化する。
【００３３】
【数４】
【００３４】
同様に、超音波パルスが油剤２を伝搬するのに要する時間T2は、傾斜角度θと音速Vとに応じて次式で示すように変化する。
【００３５】
【数５】
【００３６】
ここで、超音波パルスが送信部４から受信部５まで伝搬するのに要する時間Tは、超音波パルスが油剤１を伝搬するのに要する時間T1と、超音波パルスが油剤２を伝搬するのに要する時間T2と、超音波パルスが球形容器３の壁面を伝搬するのに要する時間ΔTとから次式で表される。
【００３７】
【数６】
【００３８】
この式の変形から、以下の傾斜角度θの算出式が導出される。
【００３９】
【数１】
【００４０】
なお、この算出式が成立するための条件としては、油剤１，２の音速U，Vが相違すること、距離L1，L2が正であることがある。音速U，Vが等しくても、距離L1，L2がゼロ、すなわち音波が界面６から外れても、音波の総伝搬時間が傾斜角度によらずに一定となってしまうためである。
【００４１】
界面距離Hを大きくするほど、傾斜角度θの変化に対する各油剤１，２内での伝搬距離の変化が大きくなり、傾斜角度の変化に対する総伝搬時間の変化の割合を大きくできるが、逆に、界面自体の面積が小さくなって音波が界面６を通過する傾斜角度θの範囲は狭くなる。界面距離Hは油剤１，２の容量比に応じて定まるため、感度と傾斜角度の測定可能範囲との兼ね合いを考慮して、油剤１，２それぞれの容量を定めると良い。
【００４２】
また、油剤１，２間の表面張力の差や球形容器３の壁との濡れ性によって、界面６は水平から微視的には湾曲する。界面６の湾曲は、球形容器３の半径Rが十分に大きければ無視できるが、半径Rが小さすぎると界面６の湾曲による測定誤差が大きくなり無視できなくなる。そのため、測定誤差と装置サイズとの兼ね合いを考慮して、球形容器３の半径Rを定めると良い。界面６をより水平とするためには、第１油剤１と第２油剤２とはそれぞれの表面張力や濡れ性が近似することが望ましい。そのため、第１油剤１と第２油剤２との表面張力や濡れ性を、改質剤などにより改質すると好適である。
【００４３】
また、傾斜角度センサ５０の傾斜に対して、界面が水平となる応答性を高めるために、第１油剤１と第２油剤２とは低粘性であることが望ましい。そのため、第１油剤１と第２油剤２との粘性を、改質剤などにより改質すると好適である。
【００４４】
また、油剤１，２間の屈折率の差によって微視的には音波は屈折するが、受信部５の位置が音波のビーム幅の範囲内に収まれば受信信号を出力できる。音波の屈折による総伝搬時間の影響は小さいため、殆ど無視することができる。
【００４５】
また、油剤１，２に替えて、水と油や、液体と気体とを採用することもできるが、各流体の不混和性が高いことが望ましく、また流体同士の泡立ちを抑える必要があるため、本実施形態では、油剤１，２を採用した。
【００４６】
また、本実施形態では、油剤１，２を充填する容器として球形容器を用いたが、垂直断面が円形の円筒形の容器を用いても良い。この場合、送信部４および受信部５を円筒形容器の例えば外周面に配置して、断面の円の中心を送信波が通過するようにすれば、上記の原理に基づいて同様に傾斜角度を取得することができる。なお、円筒形容器を用いた傾斜角度センサは、円筒形容器の中心軸まわりの傾斜のみが生じる装置に設けると傾斜角度の検出精度が高くなり好適である。
【００４７】
次に、傾斜角度センサの動作を確認するため、サンプルを作製し、傾斜角度と総伝搬時間との関係を実際に測定した結果について説明する。
【００４８】
制作したサンプルは、容器半径Rが9.45mm、界面距離Ｈが2.55mm、容器の壁の伝播時間ΔTが0.566μsec、油剤１での音速が1189m/sec、油剤２での音速が1499m/secである。
【００４９】
送信部には図2に示すパルス波形の駆動信号（振幅5V、時間幅83nsec、駆動周期170μsec）を印加し、音波の総伝播時間は駆動信号の立上り（トリガレベル1V）から検出信号のゼロクロスまでの時間とした。
【００５０】
図３は、サンプルについての実際の測定結果と、サンプルと同設定にて計算を行った計算結果とを示すグラフである。横軸は傾斜角度で、送波器が図１において球形容器の頂点の位置にある時を0°に、時計回りの傾斜を正としている。また、縦軸は超音波パルスの総伝播時間であり、測定結果と計算結果とを表している。
【００５１】
その結果、測定値、計算値とも傾斜角度0°において伝播時間が最大となった。また、角度の絶対値が大きくなる程、総伝播時間が小さくなるという傾向が一致している。よって、総伝播時間と音速等の定数とに基づいて傾斜角度を取得できることが確認できた。
【００５２】
最後に、上述の実施形態の説明は、すべての点で例示であって、制限的なものではないと考えられるべきである。本発明の範囲は、上述の実施形態ではなく、特許請求の範囲によって示される。さらに、本発明の範囲には、特許請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
【図面の簡単な説明】
【００５３】
【図１】本発明の傾斜角度センサ装置の一例である姿勢制御装置の概略のブロック図である。
【図２】本発明の傾斜角度センサの概略の垂直断面図である。
【図３】同傾斜角度センサの送信部の駆動信号と受信部の検出信号とを示すグラフである。
【図４】実施例の測定結果と計算結果とを示すグラフである。
【符号の説明】
【００５４】
１，２…油剤
３…球形容器
４…送信部
５…受信部
６…界面
５０…傾斜角度センサ
６０…機構部
７０…駆動信号生成部
８０…傾斜角度算出部
９０…制御部
１００…姿勢制御装置
【技術分野】
【０００１】
この発明は、自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサと、傾斜角度センサの出力する受信信号に基づいて傾斜角度を取得する傾斜角度センサ装置とに関する。
【背景技術】
【０００２】
自機の鉛直方向からの傾斜に応じて移動するボールを備え、ボールの位置を検出することにより、自機の鉛直方向からの傾斜方向と傾斜角度とを検出するセンサが提案されている（例えば、特許文献１および２参照。）。
【特許文献１】特開平１１−２７３５１５号公報
【特許文献２】特開平９−２９２２１９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ボールのような機械要素を備えるセンサは物理的損傷が生じ易く耐用期間が短い。
【０００４】
そこで、本発明は機械要素を用いずに傾斜角度に関する検出信号を出力する傾斜角度センサと、傾斜角度センサの出力から傾斜角度を取得する傾斜角度センサ装置とを提供することを目的とする。
【課題を解決するための手段】
【０００５】
本発明の傾斜角度センサは、自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する。そのために傾斜角度センサは、送信手段と受信手段と位置保持手段とを備える。送信手段は、自機の姿勢の鉛直方向からの傾斜角度に応じた方向に送信波を送信する。受信手段は、送信波を受信した検出信号を出力する。位置保持手段は、送信手段から送信した送信波が２種の不混和流体の間の略水平な界面を通過して受信手段にて受信される位置に送信手段と受信手段とを保持する。２種の不混和流体とは、互いの不混和性の高い２種の液体や、液体と気体などである。
【０００６】
この構成では、不混和流体の界面が水平を維持することを利用して、界面を通過する送信波を変化させる。このため、送信波を受信して生成する検出信号が傾斜角度に応じて変容する。
【０００７】
位置保持手段として、各不混和流体が異なる容量で充填された球形容器または円筒状容器を用い、送信波が球形容器の中心または円筒状容器の中心軸に垂直な断面の中心を通過する位置に送信手段と受信手段とを保持すれば、各不混和流体にて傾斜角度に応じた伝搬距離で送信波が伝搬して受信手段にて受信される。そのため、検出信号は、各不混和流体での送信波の伝搬距離に応じて変容する。
【０００８】
送信波としての音波の距離当たりの伝搬時間、すなわち音速が各不混和流体で相違すると好適である。この場合、各不混和流体での送信波の伝搬距離によって各不混和流体を通過する総伝搬時間が定まり、伝搬距離に応じて検出信号が変容する。したがって、検出信号から総伝搬時間を把握することで、送信波が各不混和流体を伝搬する伝搬距離、ひいては自機の傾斜角度が把握可能になる。
【０００９】
傾斜角度センサ装置は、傾斜角度センサと傾斜角度取得部とを備え、傾斜角度センサの出力する検出信号に基づいて音波の総伝搬時間を算出し、傾斜角度を取得してもよい。この取得には、以下の式に相当する演算を用いることができる。
【００１０】
【数１】
【００１１】
ただし、傾斜角度θ、総伝搬時間T、音波の距離当たりの伝搬時間である音速U，V、球形容器の中心から界面までの距離である界面距離H、容器の円形断面の半径R、各不混和流体以外を音波が伝搬する時間ΔTである。
【発明の効果】
【００１２】
この発明の傾斜角度センサおよび傾斜角度センサ装置は、不混和流体の界面が水平を維持することを利用して、界面を通過する送信波を傾斜角度に応じて変化させる。これにより、不混和流体を伝搬する送信波が傾斜角度に応じて変容し、送信波を受信して傾斜角度に関する検出信号を出力できる。機械要素が必要ないので物理的損傷が生じ難く耐用期間が長い。
【発明を実施するための最良の形態】
【００１３】
以下、この発明の実施形態に係る傾斜角度センサを備える傾斜角度センサ装置の一例として、機構部の姿勢を制御する姿勢制御装置を説明する。
【００１４】
図１は姿勢制御装置の概略のブロック図である。
姿勢制御装置１００は、機構部６０と制御部９０とを備える。機構部６０は傾斜角度センサ５０を備え、制御部９０は機能的に駆動信号生成部７０と傾斜角度算出部８０を備え、機構部６０を制御する。機構部６０は制御部９０からの制御により自らの姿勢を変更する。駆動信号生成部７０は駆動信号を生成して、傾斜角度センサ５０と傾斜角度算出部８０とに出力する。傾斜角度センサ５０は駆動信号によって駆動し、機構部６０の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する。傾斜角度算出部８０は、駆動信号生成部７０が出力する駆動信号と傾斜角度センサ５０が出力する検出信号とに基づいて、機構部６０の姿勢の鉛直方向からの傾斜角度を算出する。制御部９０は、傾斜角度算出部８０の算出結果に基づいて機構部６０を制御する。
【００１５】
図２は傾斜角度センサ５０の概略の垂直断面図である。
【００１６】
傾斜角度センサ５０は、一例として油剤１，２と球形容器３と送信部４と受信部５とを備える。球形容器３は、油剤1と油剤２とが充填された球形の容器であり、機構部６０にともなって姿勢を変更する。油剤１と油剤２とはそれぞれ異なる容量で球形容器３に充填されている。油剤１と油剤２とは互いの不混和性が高く、互いの境界に水平な界面６が形成され、油剤２より比重が小さい油剤１が界面６の上方で層をなし、油剤２が界面６の下方で層をなす。また、油剤１と油剤２とは、それぞれにおける距離当たりの音波の伝搬速度、すなわち音速が相違する。
【００１７】
送信部４は、球形容器３の姿勢が鉛直方向を向く際の頂点の外側に設けられていて、球形容器３の形状中心に向けて音波を送信する圧電素子を備える。受信部５は、球形容器３の外側の送信部４と対向する位置に設けられ、球形容器３の形状中心の方向からの音波を受信する圧電素子を備える。
【００１８】
この傾斜角度センサ５０では、球形容器３の姿勢を傾斜させても界面６の位置は水平に維持されるが、送信部4及び受信部５は球形容器３の姿勢の傾斜に伴って傾斜する。これにより、送信部4から受信部５までの音波の伝搬経路における界面６の位置が変化し、各油剤１，２内での音波の伝播距離が変化する。このため球形容器３の姿勢が傾斜すると、各油剤１，２内での音波の伝播時間が変化し、送信部4から受信部５までの音波の総伝搬時間も変化する。
【００１９】
したがって、受信部５にて検出する音波の検出信号における音波波形は、送信部４の駆動信号における駆動波形よりも、総伝播時間だけ遅延したものになる。これにより、音波の検出信号から総伝搬時間を計測することができる。なお、送信部４を油剤１，２の界面近傍に配置すると、音波の全反射が生じることがあって、この場合、送信部４から送信された音波を受信部５にて受信できなくなる。このため、検出角度θが検出できなくなることがある。そこで、この傾斜角度センサ５０においては、想定される傾斜角度範囲において音波の全反射が生じないような条件となるように送信部４および受信部５の位置を予め決定しておく。
【００２０】
また、油剤１，２の特性としては、それぞれでの音速が大きく異なると好適であり、望ましくは一方の音速が他方の音速の１．２倍程度はあるとよい。音速の差が大きいほど、傾斜角度の変化に対する総伝搬時間の変化の感度が大きくなるためである。
【００２１】
図３は、送信部４の駆動信号と、受信部５が出力する検出信号との関係を説明する図である。図中の（Ａ）は送信部４の駆動信号の電圧の時間変化の一例を示すグラフであり、図中の（Ｂ）は受信部５の出力する検出信号の電圧の時間変化の一例を示すグラフである。
【００２２】
駆動信号生成部７０が、時刻ｔ０に立ち上がるパルス電圧を駆動信号として、傾斜角度センサ５０の送信部４と傾斜角度算出部８０とに出力すると、送信部４の振動子は発振し音波を送波する。この音波は、送信部４の振動子から、球形容器３の壁、油剤１、油剤２、球形容器３の壁を媒体として伝搬し、時刻t１にゼロクロスをとる検出信号として受信部５で受信される。受信部５は検出信号を傾斜角度算出部８０に出力する。後述する傾斜角度算出部８０の処理では、この時刻ｔ１を利用して傾斜角度を算出する。なお、検出信号のゼロクロス時刻ではなく立ち上がり時刻を時刻ｔ１として採用すれば、受信部５を構成する圧電素子のばらつきや、送信部４から送信される音波の周波数ばらつきの影響を受けて測定精度に問題が生じる虞がある。そのため、ここでは検出信号の立ち上がり時刻ではなくゼロクロス時刻を時刻ｔ１として採用することで、上述の虞をなくし、精度の高い信号検知を行うようにしている。
【００２３】
傾斜角度算出部８０は、時刻ｔ０から時刻ｔ１までの総伝搬時間Tを検出し、この時間Tに基づいて球形容器３の傾斜角度θを算出する。傾斜角度算出部８０における傾斜角度θの算出は、以下の算出式に総伝搬時間Tと、各種定数とを代入することにより行う。ここで、各不混和流体中での音速を定数U，Vとし、球形容器３の中心から界面６までの界面距離を定数Hとし、球形容器３の半径を定数Rとし、音波が球形容器３の壁を伝搬する時間を定数ΔTとする。
【００２４】
【数１】
【００２５】
この傾斜角度算出部８０の算出結果に基づいて、制御部９０は機構部６０の制御内容を決定し、機構部６０を制御する。
【００２６】
以上の構成により、本実施形態の姿勢制御装置１００は、機械要素を用いない傾斜角度センサ５０によって、傾斜角度に関する検出信号を取得し、その検出信号から傾斜角度を取得することができる。機械要素を用いていない傾斜角度センサ５０は、故障し難く耐用期間が長い。
【００２７】
この実施形態では傾斜角度算出部８０にて傾斜角度を算出する構成について説明したが、予め、総伝搬時間と傾斜角度との対応関係を記憶したテーブルを用意しておけば、算出式を用いなくても傾斜角度を取得できるので、このようなテーブルを備えていても良い。
【００２８】
次に、傾斜角度θの算出式の導出について説明する。
【００２９】
機構部６０および球形容器３が傾斜すると、送信部４の位置も傾斜する。傾斜角度θで送信部４の圧電素子が発振すると、超音波パルスが球形容器３の壁、油剤１、油剤２、球形容器３の壁を媒体として伝搬するが、超音波パルスが油剤１の層を伝搬する距離L1と、油剤２の層を伝搬する距離L2とが、傾斜角度θと容器半径Rと界面距離Hとに応じた次式で示す値となる。
【００３０】
【数２】
【００３１】
【数３】
【００３２】
各油剤層での音速は温度や圧力などの影響を除けば一定であるため、超音波パルスが油剤１を伝搬するのに要する時間T1は傾斜角度θと音速Uとに応じて次式で示すように変化する。
【００３３】
【数４】
【００３４】
同様に、超音波パルスが油剤２を伝搬するのに要する時間T2は、傾斜角度θと音速Vとに応じて次式で示すように変化する。
【００３５】
【数５】
【００３６】
ここで、超音波パルスが送信部４から受信部５まで伝搬するのに要する時間Tは、超音波パルスが油剤１を伝搬するのに要する時間T1と、超音波パルスが油剤２を伝搬するのに要する時間T2と、超音波パルスが球形容器３の壁面を伝搬するのに要する時間ΔTとから次式で表される。
【００３７】
【数６】
【００３８】
この式の変形から、以下の傾斜角度θの算出式が導出される。
【００３９】
【数１】
【００４０】
なお、この算出式が成立するための条件としては、油剤１，２の音速U，Vが相違すること、距離L1，L2が正であることがある。音速U，Vが等しくても、距離L1，L2がゼロ、すなわち音波が界面６から外れても、音波の総伝搬時間が傾斜角度によらずに一定となってしまうためである。
【００４１】
界面距離Hを大きくするほど、傾斜角度θの変化に対する各油剤１，２内での伝搬距離の変化が大きくなり、傾斜角度の変化に対する総伝搬時間の変化の割合を大きくできるが、逆に、界面自体の面積が小さくなって音波が界面６を通過する傾斜角度θの範囲は狭くなる。界面距離Hは油剤１，２の容量比に応じて定まるため、感度と傾斜角度の測定可能範囲との兼ね合いを考慮して、油剤１，２それぞれの容量を定めると良い。
【００４２】
また、油剤１，２間の表面張力の差や球形容器３の壁との濡れ性によって、界面６は水平から微視的には湾曲する。界面６の湾曲は、球形容器３の半径Rが十分に大きければ無視できるが、半径Rが小さすぎると界面６の湾曲による測定誤差が大きくなり無視できなくなる。そのため、測定誤差と装置サイズとの兼ね合いを考慮して、球形容器３の半径Rを定めると良い。界面６をより水平とするためには、第１油剤１と第２油剤２とはそれぞれの表面張力や濡れ性が近似することが望ましい。そのため、第１油剤１と第２油剤２との表面張力や濡れ性を、改質剤などにより改質すると好適である。
【００４３】
また、傾斜角度センサ５０の傾斜に対して、界面が水平となる応答性を高めるために、第１油剤１と第２油剤２とは低粘性であることが望ましい。そのため、第１油剤１と第２油剤２との粘性を、改質剤などにより改質すると好適である。
【００４４】
また、油剤１，２間の屈折率の差によって微視的には音波は屈折するが、受信部５の位置が音波のビーム幅の範囲内に収まれば受信信号を出力できる。音波の屈折による総伝搬時間の影響は小さいため、殆ど無視することができる。
【００４５】
また、油剤１，２に替えて、水と油や、液体と気体とを採用することもできるが、各流体の不混和性が高いことが望ましく、また流体同士の泡立ちを抑える必要があるため、本実施形態では、油剤１，２を採用した。
【００４６】
また、本実施形態では、油剤１，２を充填する容器として球形容器を用いたが、垂直断面が円形の円筒形の容器を用いても良い。この場合、送信部４および受信部５を円筒形容器の例えば外周面に配置して、断面の円の中心を送信波が通過するようにすれば、上記の原理に基づいて同様に傾斜角度を取得することができる。なお、円筒形容器を用いた傾斜角度センサは、円筒形容器の中心軸まわりの傾斜のみが生じる装置に設けると傾斜角度の検出精度が高くなり好適である。
【００４７】
次に、傾斜角度センサの動作を確認するため、サンプルを作製し、傾斜角度と総伝搬時間との関係を実際に測定した結果について説明する。
【００４８】
制作したサンプルは、容器半径Rが9.45mm、界面距離Ｈが2.55mm、容器の壁の伝播時間ΔTが0.566μsec、油剤１での音速が1189m/sec、油剤２での音速が1499m/secである。
【００４９】
送信部には図2に示すパルス波形の駆動信号（振幅5V、時間幅83nsec、駆動周期170μsec）を印加し、音波の総伝播時間は駆動信号の立上り（トリガレベル1V）から検出信号のゼロクロスまでの時間とした。
【００５０】
図３は、サンプルについての実際の測定結果と、サンプルと同設定にて計算を行った計算結果とを示すグラフである。横軸は傾斜角度で、送波器が図１において球形容器の頂点の位置にある時を0°に、時計回りの傾斜を正としている。また、縦軸は超音波パルスの総伝播時間であり、測定結果と計算結果とを表している。
【００５１】
その結果、測定値、計算値とも傾斜角度0°において伝播時間が最大となった。また、角度の絶対値が大きくなる程、総伝播時間が小さくなるという傾向が一致している。よって、総伝播時間と音速等の定数とに基づいて傾斜角度を取得できることが確認できた。
【００５２】
最後に、上述の実施形態の説明は、すべての点で例示であって、制限的なものではないと考えられるべきである。本発明の範囲は、上述の実施形態ではなく、特許請求の範囲によって示される。さらに、本発明の範囲には、特許請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
【図面の簡単な説明】
【００５３】
【図１】本発明の傾斜角度センサ装置の一例である姿勢制御装置の概略のブロック図である。
【図２】本発明の傾斜角度センサの概略の垂直断面図である。
【図３】同傾斜角度センサの送信部の駆動信号と受信部の検出信号とを示すグラフである。
【図４】実施例の測定結果と計算結果とを示すグラフである。
【符号の説明】
【００５４】
１，２…油剤
３…球形容器
４…送信部
５…受信部
６…界面
５０…傾斜角度センサ
６０…機構部
７０…駆動信号生成部
８０…傾斜角度算出部
９０…制御部
１００…姿勢制御装置
【特許請求の範囲】
【請求項１】
自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサであって、
前記傾斜角度に応じた方向に送信波を送信する送信手段と、
前記送信波を受信した検出信号を出力する受信手段と、
前記送信手段から送信した前記送信波が２種の不混和流体の間の略水平な界面を通過して前記受信手段にて受信される位置に、前記送信手段と前記受信手段とを保持する位置保持手段と、を備える傾斜角度センサ。
【請求項２】
自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサであって、
前記傾斜角度に応じた方向に送信波を送信する送信手段と、
前記送信波を受信した検出信号を出力する受信手段と、
前記送信手段から送信した前記送信波が、２種の不混和流体の間の略水平な界面を通過し、各不混和流体にて前記傾斜角度に応じた伝搬距離で伝搬して前記受信手段にて受信される位置に、前記送信手段と前記受信手段とを保持する位置保持手段と、を備え、
前記受信手段は、前記伝搬距離に応じて変容した前記検出信号を出力する、傾斜角度センサ。
【請求項３】
前記位置保持手段は、各不混和流体が異なる容量で充填された球形容器または円筒状容器であって、前記送信波が前記球形容器の中心または前記円筒状容器の中心軸に垂直な断面の中心を通過する位置に、前記送信手段と前記受信手段とを保持する、請求項２に記載の傾斜角度センサ。
【請求項４】
前記送信波は音波であり、
各不混和流体は、距離当たりの前記音波の伝搬時間がそれぞれ相違し、
前記受信手段は、前記音波の総伝搬時間に応じて変容した検出信号を出力する請求項２または３に記載の傾斜角度センサ。
【請求項５】
請求項３に記載の傾斜角度センサと、
前記受信手段の出力する前記検出信号に基づいて前記音波の総伝搬時間を取得し、以下の式に相当する演算により前記傾斜角度を取得する傾斜角度取得部と、
を備える傾斜角度センサ装置。
【数１】
ただし、前記総伝搬時間をTとし、前記傾斜角度をθとし、各不混和流体中での距離当たりの音波の伝搬時間をU，Vとし、前記球形容器の中心から前記界面までの距離をHとし、前記容器の円形断面の半径をRとし、前記総伝搬時間のうち各不混和流体以外を前記音波が伝搬する時間をΔTとする。
【請求項１】
自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサであって、
前記傾斜角度に応じた方向に送信波を送信する送信手段と、
前記送信波を受信した検出信号を出力する受信手段と、
前記送信手段から送信した前記送信波が２種の不混和流体の間の略水平な界面を通過して前記受信手段にて受信される位置に、前記送信手段と前記受信手段とを保持する位置保持手段と、を備える傾斜角度センサ。
【請求項２】
自機の姿勢の鉛直方向からの傾斜角度に関する検出信号を出力する傾斜角度センサであって、
前記傾斜角度に応じた方向に送信波を送信する送信手段と、
前記送信波を受信した検出信号を出力する受信手段と、
前記送信手段から送信した前記送信波が、２種の不混和流体の間の略水平な界面を通過し、各不混和流体にて前記傾斜角度に応じた伝搬距離で伝搬して前記受信手段にて受信される位置に、前記送信手段と前記受信手段とを保持する位置保持手段と、を備え、
前記受信手段は、前記伝搬距離に応じて変容した前記検出信号を出力する、傾斜角度センサ。
【請求項３】
前記位置保持手段は、各不混和流体が異なる容量で充填された球形容器または円筒状容器であって、前記送信波が前記球形容器の中心または前記円筒状容器の中心軸に垂直な断面の中心を通過する位置に、前記送信手段と前記受信手段とを保持する、請求項２に記載の傾斜角度センサ。
【請求項４】
前記送信波は音波であり、
各不混和流体は、距離当たりの前記音波の伝搬時間がそれぞれ相違し、
前記受信手段は、前記音波の総伝搬時間に応じて変容した検出信号を出力する請求項２または３に記載の傾斜角度センサ。
【請求項５】
請求項３に記載の傾斜角度センサと、
前記受信手段の出力する前記検出信号に基づいて前記音波の総伝搬時間を取得し、以下の式に相当する演算により前記傾斜角度を取得する傾斜角度取得部と、
を備える傾斜角度センサ装置。
【数１】
ただし、前記総伝搬時間をTとし、前記傾斜角度をθとし、各不混和流体中での距離当たりの音波の伝搬時間をU，Vとし、前記球形容器の中心から前記界面までの距離をHとし、前記容器の円形断面の半径をRとし、前記総伝搬時間のうち各不混和流体以外を前記音波が伝搬する時間をΔTとする。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２００９−２６４８３１（Ｐ２００９−２６４８３１Ａ）
【公開日】平成２１年１１月１２日（２００９．１１．１２）
【国際特許分類】
【出願番号】特願２００８−１１２７１４（Ｐ２００８−１１２７１４）
【出願日】平成２０年４月２３日（２００８．４．２３）
【出願人】（０００００６２３１）株式会社村田製作所 (3,635)
【公開日】平成２１年１１月１２日（２００９．１１．１２）
【国際特許分類】
【出願日】平成２０年４月２３日（２００８．４．２３）
【出願人】（０００００６２３１）株式会社村田製作所 (3,635)
[ Back to top ]