2モード ボールセンサ ..... WS03W
ロボカップジュニア・サッカーチャレンジのルールでパルス発光ボールが規定されています。
従来の定常光ボールは外光の影響が問題でしたが、パルス光は
対応するボールセンサと組み合わせると、外光の影響を受けにくくなります。
和歌山ノードでは、パルス光ボールに対応するためのボールセンサを開発しています。
WS03Wは、アナログ入力を持ったロボットに使うことを目的に作られた、
定常光モードとパルス光モードに切り換えで対応できるボールセンサです。
WS03W
» 終了製品一覧にもどる
特徴
- 定常光ボールセンサの回路とパルス光ボールセンサの回路の2モード切り換え式
- パルス光モード回路は、PAM(パルス振幅変調)復調とPWM(パルス幅変調)復調を併用した
リモコン受光器を使わない半固定ゲイン方式で、外光の影響を受けにくく、
ボールまでの距離に対して出力の変化が大きい。
近いボールの反応が敏感なので、ドリブラー,ボールを狙ってのキックなどの制御に適する。
(遠いボールを捜すにはAGC方式のWS01B/WS02が適する)
- 電源は3.3V~5.0Vで動作する。電源の最大定格は 5.25V
- 寸法 57mm×27mm 高さ約12mm 取り付け穴径3.2mm
外形
端子のピン配置はTJ3と同じです。電線を直接ハンダ付けするか、
取り付け場所に合う 2.5mmまたは2.54mmピッチのコネクタを付けてください。
回路
定常光モード
定常光ボールが発する光は一定の強さです。
フォトダイオードで光の強さを電流に変換します。
定常光モードの時には、フォトダイオードの信号を増幅して電圧信号で出力します。
半固定抵抗で振幅を調整できます。
至近距離でも飽和しにくくするため、出力が大きいときにゲインを低くする2段ゲインアンプにしています。
パルス光モード
パルスボールが発する光は、次の信号の合成になっています。
- 40kHzのキャリア(搬送波)
- 1200Hzのサブキャリア(副搬送波)
- ボールまでの距離を反映した直流の変調信号
フォトダイオードで、受けた光の強さを電流に変換します。
この信号は太陽光や照明光を含んでいるので、パルス光モードの時には
キャリア周波数だけを通すバンドパスフィルタ(BPF)で不要な信号を取り除きます。
BPFの後、全波整流した信号は、サブキャリアと変調信号からできています。
これをサブキャリアを取り除くローパスフィルタ(LPF)に通すと、変調信号が得られます。
LPFは、直流の変調信号を通し、高い周波数のサブキャリアを通さない回路です。
半固定抵抗で振幅を調整できます。
WS03Wのパルス光モードは受光に高速フォトダイオードを使った半固定ゲイン方式です。
一方、受光に赤外線リモコン受光ICを使う自動ゲイン制御(AGC)方式もあります。
リモコン受光ICにはAGC回路が内蔵されており、受光の強さによって自動的に感度を調節します。
そのため、ボールから受けた光の強弱によるセンサ出力の変化が小さい特徴があります。
半固定ゲイン方式は半固定抵抗で設定した一定の感度で働きます。
そのため今までの定常光ボールセンサと同じように、ボールからの光の強さに敏感に反応し、
ボールが近い時は出力が大きく、遠いときは出力が小さくなります。
そのためAGC方式に比べて至近距離でのボールまでの距離がわかりやすくなります。
J1を開放にするとパルス光モードになり、短絡すると定常光モードになります。
モードは電源を入れた時に切り換わり、電源を入れ直すまではJ1を変えてもモードは切り換わりません。
動作
ボールまでの距離による定常光センサの反応をグラフにしたものです。
ボールまでの距離によるパルス光センサの反応をグラフにしたものです。
◆グラフは代表的な特性をあらわしています。
ボールの角度や電池残量、周囲の状況、センサの個体差 などによって変わります
実験
WS03Wをダイセン電子のOJ2に取り付けて、これで回り込みの実験。
ボールセンサ WS03W をサッカーロボットに取り付けて、回り込みプログラムを実行させてみました。
回り込みプログラムは、ボールが見えていれば右へ、見えなければ左へ
曲がる動作を永久に繰り返します。
この実験で、センサの光を感じる角度範囲(指向性)がわかります。
2個のWS03Wを角度を付けてダイセン電子のOJ2に取り付け、これでシュートの実験。
ボールセンサ WS03W をサッカーロボットに取り付けて、
ボールを捜して、ボールが見つかればその方向へ走るプログラムを実行させてみました。
2つのセンサを左右斜め前向きに付けてあるので、
強い光を受光する方向にボールがあるとして、その方向に走るプログラムです。
センサが2つあれば、ボールが右か左か正面かがわかるので
ボールに向って走ることができます。