I/O Subボード
last up date 5/25
1 超音波センサ回路の機能概要
超音波センサ回路の機能は大きく分けて、トリガが送られて来ると周波数40[kHz]の矩形波を0.4[ms]の間、送信回路
に出力する機能と、受信信号を受け取ると、割り込み要求信号をMPUに送る機能の二つがある。また、正しく距離計測を
行うために、回りこみ波を無視する機能も備え付けられている。
距離計測はPITに内蔵されているタイマを利用している。このタイマは、トリガを受け取った時点でカウントを開始し、
受信を感知すると停止する。このカウンタ値を読み込む事により障害物迄の距離を知ることができる。すなわち、タイマの
クロック周波数は8×106/32[Hz]であるので、障害物までの距離Lは、
L=
* L:距離 v:音速 Count:カウント値
で与えられる。最後の1/2は、超音波が障害物までの距離を往復することを考慮しているためである。
しかしながら、音速vは一定値ではなく、周囲の温度で変化するため、この方法では、ある程度の誤差は覚悟しなければ
ならない。しかし温度によるLの誤差は非常に小さいので、、MIRS競技に使用するには問題はないと思われる。
2 回路構成
図1に回路構成図を示す。図1より@からEのブロックの機能について説明する。
@ 発振回路
この回路は、コンデンサの放電を利用し、ゲートと組み合わせて構成した簡単な発振回路である。超音波センサ回路
のメインクロックともなる重要な回路である。この回路では正確に40[kHz]の周波数を作り出すことは難しいが、40[kHz]近い
周波数で安定していれば動作に支障はない。またICにCMOSを使用しているので、回路自体がデリケートなこと、
コンデンサの放電を利用しているので、少しの状況の変化(接触や、端子の先のRの値)によって、発振したりしなかったり
と言うこともあるが、回路周辺の設計に注意すればこの問題は解消される。
中央の抵抗値によって周波数が変化するので、最初は可変抵抗で抵抗値を変化させながらオシロスコープで、周波数を調べ
丁度40[kHz]の周波数を示した時、その時の可変抵抗の抵抗値にできるだけ近い値(約5.6kΩ)を持つ抵抗を付けた。
A ワンショット回路
図2にPLDにプログラムされたワンショット回路構成図を示す。ワンショット回路は、64進カウンタと制御回路で、
構成されており、PLDを2つ使っている。
この回路から、トリガ一回毎に、ガードパルス、タイミングパルス、送信用ワンショットを一回づつ出力する。送信用
ワンショットとCLKとのANDをとって幅0.4[ms]、周波数約40[kHz]のパルスを送受信回路に出力する。ガードパルス、
タイミングパルスは、比較回路の項で述べる事にする。
B タイマ制御部
PITのタイマを動かしたり、止めたりする部分である。タイマのカウントはトリガが送られてきてから、送信、又は
タイマのオーバーフローが起こるまでの間行われる。この制御はRSフリップフロップで行い、タイマのスタート信号の
ON−OFF制御をする。
PIT内臓のタイマは、設定によりいろいろ選べるが、この回路ではオーバーフローを検出できる「Device.Watchdog」
という設定を選んだ。
C 比較回路
この回路では、主にノイズの除去と回り込み波による影響の無視をおこなう。受信回路から送られてきた受信波と、
基準電圧をコンパレータで比較し、基準電圧より低い電圧の信号を除去する。
また、回り込み波の除去については送信してから、一定時間基準電圧のレベルをあげることで対処する。この時間は
タイミングパルスによって決められる。さらに送信開始から一定時間受信そのものを無視する方法をとり、二重の対策を
とっている。
D 基準電圧発生部
超音波は波の性質を持っているため、スピーカから発信された超音波が、直接マイクで受信されてしまう。このため、
障害物からの距離に関係なく、同じタイミングで受信が行われることのなる。回りこみはを受信するタイミングがわかって
いれば、その間だけ基準電圧を5Vに引き上げれば、回りこみ波による影響をコンパレータによって打ち消すことができる。
この基準電圧発生部は、コンデンサの放電を利用して、タイミングパルスから基準電圧を作り出す部分である。
E マルチプレクサ
搭載されている4対のセンサのうち、一度に距離計測ができるのは一対だけである。計測をおこなうときには4対の内
1対を選ばなければならない。マルチプレクサは、コネクタを通じて4つの送信回路と直結しており、PITから送られて
くるセンサ選択信号により、使用する1対のセンサを選択する。センサにはそれぞれ0から3まで番号がつけられていて、
センサ選択信号もそれに対応して00から11までの2ビットの信号により成り立っている。
3 PWM回路の機能概要
図1に示すPWM回路は、モータを制御する信号であるPWM信号を作り出し、方向データとともに出力する回路である。
速度データとカウンタのカウント値との比較によりPWM信号を形成している、この信号のDuty比は、速度データで
128段階に変化させている。
4 回路構成
上の図1に回路構成図を示す。右速度・方向データは68230のpartAから、左速度・方向データはportBから送られてくる。
カウンタのCLKは、68230のToutから得ている。PWM信号発生回路は、カウンタより得られた8ビットのカウント値と
7ビットの速度データとの比較によりPWM信号を形成している。PWM信号波形形成原理を図2に示す。Duty比は
0%から50%で、これを128段階に分けている。速度データをnとするとPWM信号のパルス幅TとDuty比Dは
次式で計算できる。
T[μs]=(n+1)×5[μs]
D[%]=(n+1)/256×100
(0≦n≦127)
5 赤外線センサ回路の機能概要・回路構成
この回路は、赤外線周辺回路から送られてくるHigh levelもしくはLow levelの信号を処理し信号に変化が起きたときに、
割り込み要求信号をMPUに送る機能を持つ。またその時の各受光素子の状態は後述のレジスタを読むことにより得る。
I/OSUBボードに搭載されているこの信号処理部は主に周辺回路からの赤外線信号の同期をとる信号同期部と、68230に
割り込み要求をする割り込み信号発生部から成る。図1に回路構成図を示す。
6 I/O Subのインターフェイス
各ボードとセンサの詳細へ戻る