PIC 制御による赤外線障害物自動回避走行車

PIC制御による赤外線障害物自動回避走行車 IE4　　　青木　友宏　　梶山　直幹河野　直高　　　中村　俊

目的・概要 • PIC制御で赤外線ＬＥＤと赤外線センサにより障害物を検知し、自動で障害物を回避しながら走行する車を作成する

機能・動作 • ２輪駆動の２輪走行車である • モータを２つ持ち、左右の車輪を独立に制御することで前進、後退、右折、左折などを行うことが出来る • ２つの赤外線ＬＥＤ、１つの赤外線センサを持ち２段階の距離による障害物の検出を行う。それにより曲がる強弱を変える

PIC１６F８４A セラロック（２０MHz） ICソケット　１８P コンデンサ×３可変抵抗×２抵抗×１電源（単三電池×４）ダイオードハードウェア部分の仕様・１

ハードウェア部分の仕様・２ ・赤外線センサ　同期点滅を行い、自分が必要な信号のみに反応するようにする　３８KHzの同期周波数にて点滅させる・赤外線LED（障害物検知用）×２　左右それぞれ遠くと近く２段階の距離の検出を行う　左右の点灯は左の表に　あるようにポートの状態を制御することで実現している

ハードウェア部分の仕様・３ ・モータドライバIC 　PWM制御によって前進後退の速度制御を行っている　オンとオフしかないモータに対して高速にオンオフを切り替えて、そのオンしている時間を変更することで速度の変更を行っている高速：＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾＾早め：|＾＾＾|_|＾＾＾|_|＾＾＾|_|＾＾普通：|＾＾|__|＾＾|__|＾＾|__|＾＾遅い：|＾|___|＾|___|＾|___|＾停止：__________________

割り込み どちらの赤外線ＬＥＤを光らすか判断カウンタの最下位bit=0 N y 赤外線ＬＥＤ発光赤外線ＬＥＤ消灯割り込み終了ソフトウェア部分の仕様・１ＳＴＡＲＴ初期化ポート入力処理 ① 赤外線ＬＥＤ：障害物があるか判断 ①によってモータをどのように回転させるかを決める。

ソフトウェア部分の仕様・２ 1.126msecずつで変更

工夫点１ ・頻繁に使用する命令をマクロ化することでプログラムをコンパクトにしている・回路はなるべく単純なものにし、ソフトで多くの制御を行える用にしている・３８ｋHzの赤外線発光は毎１６usecの割り込みによって表現している・割り込み部分は最低限のことしかやらない。赤外線発光だけ、左右強弱の判定はしない

問題点 ・赤外線LEDを左右に角度をつけて配置しているため、車体の正面にある障害物の検知をすることができない　遠くの物を検知しすぎてしまい回転してしまう・左のモータと右のモータの回転数が何故かあっていないため直進することができず、常に左に向かって進んでしまう・スイッチのON・OFF後の動作が不安定である

PIC 制御による赤外線障害物 自動回避走行車