...

センサを搭載したマイコンロボットの設計と製作

by user

on
Category: Documents
62

views

Report

Comments

Transcript

センサを搭載したマイコンロボットの設計と製作
特別研究報告書
題 目(日本語,英語)
センサを搭載したマイコンロボットの設計と製作
(Design and Fabrication of the electronic circuits for miniature
mobiles with sensors)
指 導 教 員
綿森 道夫
報 告 者
学籍番号: 1055091
氏名: 新田 敏弘
平成 17 年 2月 20 日
高知工科大学 電子・光システム工学コ−ス
目次
第1章 はじめに................................................................................ 1
第2章 研究目的 .............................................................................. 2
第3章 使用するプロセッサについて ...................................................3
3−1 PICプロセッサについて ...........................................................3
3−2 PICの概要 .........................................................................4
第4章 赤外線センサを用いた黒ラインを検出する回路の設計と製作 ....8
4−1 実験の目的.............................................................................8
4−2 黒ラインを検出する方法の原理 ................................................8
4−3 モータードライバーを用いてモーターの回転方法を
制御する方法 ........................................................................10
4−4 応用例..................................................................................12
4−4−1 ライントレース/ランダム移動切り替えマウスの動作原理..12
4−4−2 ライントレース/ランダム移動切り替えマウスの回路製作 .17
4−5 実験回路の動作確認.............................................................18
4−5−1 実験回路の動作不良の原因と修正 .............................18
4−5−2 実験回路修正後の動作確認.......................................19
4−6 検討 ......................................................................................20
第5章 赤外線/無線切り替えリモコン走行車の製作と動作確認 ........21
5−1 実験の目的 .........................................................................21
5−2 赤外線を用いた送受信回路の原理と問題点 .........................21
5−3 FM電波を用いた送受信回路の原理と問題点.......................22
5−4 応用例 ................................................................................22
5−4−1 赤外線/無線切り替えリモコン走行車の動作原理 .........22
5−4−2 赤外線/無線切り替えリモコン走行車の回路製作 ........23
5−5 実験回路の動作確認...........................................................55
5−6 検討....................................................................................56
i
第6章 加速度センサを用いた角度検出器の設計と製作 ....................57
6−1 実験の目的...........................................................................57
6−2 加速度センサを用いた角度検出器の原理 ..............................57
6−3 ダイナミック点灯方式について................................................58
6−4 応用例..................................................................................58
6−4−1 加速度測定器の動作原理..........................................58
6−4−2 加速度測定器の製作 .................................................59
6−5 実験回路の動作確認.............................................................60
6−6 検討 .....................................................................................63
第7章 加速度センサ、FM電波送受信回路、モーターコントロール
回路を組み合わせた回路の設計と製作 ..................................64
7−1 実験の目的...........................................................................64
7−2 実験回路の製作 ....................................................................64
7−2−1 ロボットアームの送受信回路の動作原理 .....................64
7−2−2 ロボットアームの送受信回路の回路製作 .....................65
7−3 実験回路の動作確認 .............................................................68
7−4 検討 ......................................................................................68
第8章 まとめ ...................................................................................70
参考文献 ................................................................................................71
謝辞 .......................................................................................................72
ii
第1章 はじめに
現在、我々の身の周りには各種センサを用いた電化製品が数多く存在する。
いくつか例を挙げると、防犯のためのセキュリティ機器やOA機器、医療機器
等がある。いずれに於いても、現代社会を生きる我々にとって重要な役割を占
めている。特にセキュリティに関しては家庭レベル、あるいは個人レベルでそ
れぞれ固有のものが必要になってくると予想される。ここでは特に重要なセン
サ機器に着目し、本研究では、PICプロセッサを用いた、いくつかのセンサ
回路を製作し動作させる。
本論文の構成として、第3章には、回路製作に用いられたPICプロセッサ
の説明が記述される。第4章から第7章にかけて、実際に製作されたそれぞれ
のセンサ回路が動作するに至るまでの過程が記述される。
1
第2章 研究目的
本研究では、まずPICプロセッサを用いて各種センサを制御することを試
みる。そして、その応用例として、センサを組み込んで、実際に動きのある模
型を製作することが目的である。また、これらの製作された動きのある模型か
ら、センサの使用法の新しい発想を生み出すことも本研究に於ける目的である。
2
第3章 使用するプロセッサについて
3−1 PICプロセッサについて
PICとは1980年に、アメリカのGI社が、コンピュータの周辺装置の
制御用マイコンとして開発したものであり、コンピュータに接続するフロッピ
ーディスク装置やハードディスク装置に内蔵されたものである。その後、PI
Cの多様化が進められ、1989年に、GI社から独立したマイクロチップテ
クノロジー社がPICの開発を続けている。
現在では、コンピュータの周辺装置だけでなく、冷蔵庫や炊飯器等の家電製
品や携帯電話に使用されている。また、自動車を例に挙げると、PICを使用
しない部分は、自動車のエンジンの主要部分に組み込まれているワンチップマ
イコンがあり、ワイパーや方向指示器、スピードメータやエアコン制御にPI
Cが使用されている。現在では、研究用ロボットの制御や趣味の電子工作に使
用されるまでに応用分野が広がっている。
図3.1 PICを使用した電子工作の一例(受光による時間計測器)
3−2 PICの概要
3
PICの概要として次のことが記載される。
(1)PICと一般のマイコンの機能とその相違点
一般のマイコンに内蔵された機能(Z80 等)
・
・
・
・
周辺回路
命令解読、命令実行部
演算処理部
内部データバス
PICに内蔵された機能
・ 周辺回路
・ 命令解読、命令実行部
・ 演算処理部
・ データメモリ、プログラムメモリ
・ データバス、プログラムバス
一般のマイコンアーキテクチャーはノイマン型アーキテクチャーと呼ばれ、メ
モリが内蔵されておらず、外部データバスによって、メモリを接続している。
また、一般のマイコンには周辺回路が内蔵されていない場合があり、外部デー
タバスを接続する必要がある。
(2)命令数が35個である
4
PIC(16F84A)には全部で35個の命令がある。これらを用いて、
プログラムを作成し、ソフトウェアのMPLABを用いてマシン語にアセンブ
ルさせ、PICに書き込ませる。その過程を経て、PICを動作させている。
バイト対応命令 命令の種類
転送
算術演算
論理演算
ローテイト(ビット回転)
ジャンプ
クリア
ビット対応命令
数値対応命令
命令
MOVF、MOVWF、SWAPF
ADDWF,SUBWF, INCF, DECF
ANDWF,IORWF, COMF, XORWF
RRF,RLF
INCFSZ,DECFSZ
CLRF,CLRW
ビット操作 BCF,BSF
ジャンプ
BTFSC,BTFSS
転送
算術演算
論理演算
ジャンプ
クリア
制御
MOVLW
ADDLW,SUBLW
ANDLW,IORLW,XORLW
CALL,GOTO,RETURN,RETLW,RETFIE
CLRWDT
SLEEP
表3.1 PIC(16F84A)の全命令
(3)PIC(16F84A)のピン配置
5
PIC16F84Aには足の数が全部で18ピンある。PICに書き込まれ
たプログラムの命令により、それぞれのPICの足の役割が決められる。
ピン番号
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
名称
RA2
RA3
RA4/TOCKI
MCLR(NOT)
Vss
RB0/INT
RB1
RB2
RB3
RB4
RB5
RB6
RB7
Vdd
OSC2/CLKOUT
OSC1/CLKIN
RA0
RA1
説明
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート、タイマクロック
リセット
アース
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
双方向I/Oポート
正電源
クロック端子2
クロック端子1
双方向I/Oポート
双方向I/Oポート
表3.2 PIC(16F84A)のピン配置
(4)PICの種類
PICには大きく分けると、3つの種類がある。まず始めに、命令語調が
12ビットのベースライン製品がある。ベースラインのPICは12C508
や16C54等があり、価格や性能は3種類の中では一番低いPICである。
次に、ミドルレンジ製品がある。命令語調が 14 ビットあり、PICの機種と
して、16F84や16F877A等がある。ミドルレンジ製品は、簡単な機
6
能を持つものから、高機能のものがあり、扱いやすいPICとして幅広く使用
されている。
最後に、ハイエンド製品がある。命令語調が16ビットで、PICの機種と
して17C44や18F452がある。ハイエンド製品には、乗算器内蔵タイ
プや、命令数77個を持つものもある。
(5)ファイルレジスタ
PICにはファイルレジスタと呼ばれるビット幅8ビットのメモリがある。
ファイルレジスタにはSFRレジスタと汎用レジスタがある。ファイルレジス
タは 0 番地から7F番地まであり、0 番地から0B番地がSFRレジスタである。
SFRレジスタとは、PICの各種設定を行うレジスタであり、主な働きとし
て、割り込み処理の許可やバンクの切り替え等がある。
アドレス
バンク0
0 INDF
1 TMR0
2 PCL
3 STATUS
4 FSR
5 PORTA
6 PORTB
7 未使用
8 EEDATA
9 EEADR
0A PCLATH
0BINTCON
バンク1
OPTION_REG
PCL
STATUS
STATUS
FSR
TRISA
TRISB
未使用
EECON1
EECON2
PCLATH
INTCON
4F 汎用レジスタ
表3.3 16F84Aのファイルレジスタ
7
第4章 赤外線センサを用いた黒ラインを検出
する回路の設計と製作
4−1 実験の目的
フォトインタラプタと呼ばれる赤外線センサの仕組みを学ぶため、工作キッ
トのねずみロボットを用いる。フォトインタラプタは、反射する光により、電
流を流すか、流さないかを操作する働きがある。この働きを利用して、地面に
張られた黒いラインに、ねずみロボットを置いて動作させ、黒ラインに対して、
何らかの動きをさせた。
ねずみロボットにフォトインタラプタを組み込むにあたって、電源スイッチ
の他に、2種類の動きを切り替えるためのスイッチを用意した。一方の働きと
して、ねずみロボットは、組み込まれたフォトインタラプタが黒いラインを避
け続けるよう設計された。
また、もう一方の働きとして、フォトインタラプタが黒いラインに沿って動
作するように、ねずみロボットは設計された。
4−2黒ラインを検出する方法の原理
4−1章に於いて、ねずみロボットに黒ラインを検出するため、フォトイン
タラプタを用いたと記述した。フォトインタラプタの内部にはLEDとフォト
トランジスタが内蔵されている。フォトインタラプタを、地面に張られた黒ラ
インに接近させたとき、フォトインタラプタ内のLEDの光が反射しない。も
し、白い地面にフォトインタラプタを接近させたとき、フォトインタラプタ内
のLEDからの光が反射される。反射された光は、フォトインタラプタ内のフ
ォトトランジスタが反応して、コレクタからエミッタに電流が流れる。よって、
フォトインタラプタの出力には電源電圧と同等の電圧がかかる。この動作は、
フォトインタラプタをエミッタ出力で用いた場合の働きであるが、反射した光
8
+3V
をフォトインタラプタ内のフォトトランジスタに検出された場合に、フォトイ
ンタラプタの出力にアース電圧と同等の電圧をかけたい場合には、フォトイン
タラプタをコレクタ出力にする必要がある。ここで、ライントレース/ランダム
切り替えマウスを製作にインバータICを用いた。これは、PICマイコンに
入力される信号の誤動作を防止するためである。
フォトインタラプタを3Vで動作させる場合、フォトインタラプタ内のダイ
オードに流れる電流を約4.4mAにするため、図4.1の抵抗R1を 110Ωに
設計する必要がある。また、フォトトランジスタに電流0.1mAを流すため、
抵抗R5を30kΩに設計する必要があるが、図4.1では、フォトトランジ
スタの感度を上げるために、抵抗R5をさらに感度の高い62kΩに設計して
いる。
GP2S40
U6
GP2S40
R5
62k
R1
110
図4.1 本研究に用いられたフォトフォトインタラプタ(エミッタ出力
の場合)
9
白地
黒ライン
フォトインタラプタからの出力 インバータを通した時の出力
1
0
0
1
表4.1 フォトインタラプタからの出力(エミッタ出力)
4−3 モータードライバーを用いて、モーターの回転方法を制御
する方法
ねずみロボットを実際に動作させるためモーターを用いる。モーターを動作
させるためモータードライバーという素子を用いる。図4.2で、モータード
ライバーを動作させるには、IN1、IN2に電圧をかけなければならない。
モータードライバーのIN1、IN2のどちらかに電圧をかけることで、モー
ターの正回転、逆回転を操作できる。ねずみロボットにモーターを2つ用いる
ことにより、動作の種類を増やした。そして、それぞれのモーターに、モータ
ードライバーを接続し、モータードライバーのIN1とIN2のピンをPIC
16F628に接続することにより、ねずみロボットを前進と後退や回転させ
た。モータードライバーと接続されたPIC16F628の各ピンに、それぞ
れ電圧を出力させた場合の動作を表4.2に記述する。PIC16F628に
プログラムを書き込むことにより、PIC16F628からの出力は操作され
る。
10
1 GND
2 MC1
3 NC
4 Vref
5 IN1
6 IN2
7 Vcc
8 Vs
9 NC
10 MC2
図4.2 モータードライバー(TA7291P)
RA3
RA2
1
0
1
1
1
1
0
0
RA1
0
1
1
1
0
1
1
1
RA0
1
0
1
1
1
0
1
1
0
1
1
0
1
1
1
0
ねずみロボットの動作
前進
後退
停止
前進左回転
前進右回転
後退右回転
後退左回転
高速左回転
表4.2 ねずみロボットの動作の種類
11
4−4 応用例
4−4−1 ライントレース/ランダム移動切り替えマウスの動作原
理
赤外線センサの学習のため、ライントレース/ランダム移動切り替えマウスを
製作した。
まず、ライントレース回路は、ライントレース/ランダム切り替えマウスの先
端に取り付けられたフォトインタラプタにより、地面に張られた黒ラインに対
して、次に記述した動作を行うようにした。
・図4.8のフォトインタラプタbcdの働き(黒ライン検出は1)
010 直進
110 左折
011 直進
111 左折
100 左折
001 右折
101 左折
000 左旋回
上記の働きするようPIC16F628にプログラムを書き込み、動作させた。
次にランダム移動マウス回路は、地面に張られた黒ラインの有無で、ランダ
ムに動きを変化させるため、PIC16F628にプログラムを書き込む。ラ
12
ンダム移動マウス回路のプログラムのフロチャートは図4.4、図4.5、図
4.6、図4.7になる。
動きタイマ変数 x_tp
main
速度タイマ変数 x_ts
スピード変数 x_s
x_tp=0
x_ts=0
Y
N
next_p
N
next_s
x_tp>0?
Y
x_ts>0?
Y
N
x_s≠1?
Y
N
x_s≠2?
Y
N
x_s≠3?
wait_h
wait_m
wait_l
x_tp:1を引く
x_ts:1を引く
図4.4 ランダム移動マウス回路のメインルーチンフロチャート
13
next_p
ptr_p:1 を足す
N
ptr_p<53
ptr_p=0
Y
dat_pfのptr_p番目の
データをx_pに
ptr_tpに
1を足す
N
ptr_tp<29
ptr_tp=0
Y
dat_pfのpt
r_p番目のデー
タをx_pに
RET
図4.5 ランダム移動マウス回路の動きとタイマフロチャート
14
next_s
ptr_s:1 を足す
N
ptr_p<30
ptr_s=0
Y
dat_pfのptr_p番目の
データをx_sに
ptr_tsに
1を足す
N
ptr_tp<31
ptr_ts=0
Y
dat_tspのptr_ts番
目のデータをx_tsに
RET
図4.6 ランダム移動マウス回路のスピードとタイマフロチャート
15
intrpt
N
sfl=1?
fl
N
Y
sfr=1?
fr
N
Y
srl=1?
rl
N
Y
srr=1?
rr
N
RET
図4.7 ランダム移動マウス回路の動き検出フロチャート
16
4−4−2 ライントレース/ランダム移動切り替えマウスの回路製
作
赤外線センサを用いて黒ラインを検出する回路を設計するため、図4.3の
回路を製作した。図4.3の回路の電源はモータードライバーが動作するに十
分な3Vに設計された。
図4.3の回路は、PIC16F628のRB2ポートに加わる入力電圧の有
無で、ライントレース回路とランダム移動マウス回路が切り替わる設計になっ
ており、それぞれの回路はプログラムで制御される。ライントレース回路に於
いて、移動マウスが、行き止まりに差し掛かった場合、動作を止める働きをす
る。その働きを知らせるために、RB0とRB1のポートにそれぞれ接続され
たLEDが交互に光るように図4.3の回路は設計された。LEDが光るよう
+3V
に電流を5mA流すため、200Ωの抵抗を接続することにした。
GP2S40
U6
GP2S40
R5
62k
R1
110
17
RA3
RA1
D4
DIODE
R9
200
R11
200
RA1 18
RA0 17
RA7 16
RA6 15
Vcc 14
RB7 13
RB6 12
RB5 11
RB4 10
+3V
1 RA2
2 RA3
3 RA4
4 RA5
5 GND
6 RB0
7 RB1
D1
8 RB2
DIODE 9 RB3
C1
47uF
RA2
M1
C4
0.1uF
16f628
1 GND
2 MC1
3 NC
4 Vref
5 IN1
6 IN2
7 Vcc
8 Vs
9 NC
10 MC2
R
RA0
U5
+3V
L
U4
U1
1 GND
2 MC1
3 NC
4 Vref
5 IN1
6 IN2
7 Vcc
8 Vs
9 NC
10 MC2
M2
TA7291P
TA7291P
RB2
S2
R8
10k
P14 14
P13 13
P12 12
d
P11 11
P10 10
P9 9
c
P8 8
+3V
+3V
RA7
RA6
a12 P1
3 P2
4 P3
P4
b56 P5
7 P6
P7
+3V
RA4
U2
+3V
GP2S40
U6
GP2S40
U7
RPR-220
74HC14
RA5
U3
RB7
RB6
RB5
e12 P1
P2
f34 P3
P4
g 56 P5
7 P6
P7
R1
110
P14 14
P13 13
P12 12
P11 11
P10 10
h
P9 9
P8 8
RPR-220
R5
62k
R10
110
+3V
R3
62k
S3
+3V
74HC14
RB4
+ Vcc1
3V
図4.8 赤外線/ランダム移動切り替えマウスの回路図
4−5−1 実験回路の動作不良の原因と修正
実際に、図4.8の回路を製作し、動作させた。しかし、U2のインバータ
に接続されたフォトインタラプタcが黒ラインに対しての反応が弱かったので、
写真4.1のように、黒い紙で敷居をした。
18
写真4.1 図4.8の回路の修正
4−5−2 実験回路修正後の動作確認
4−5−1章のように図4.8回路に修正をした結果、スイッチの切り替え
により、ライントレースにした場合には、黒ライン上に走り、ランダム移動マ
ウスにした場合は、黒ラインを避ける動作をした。しかし、黒ラインを検出す
るのが遅いので、それが今後の課題である。この製作したライントレース/ラ
ンダム移動切り替えマウスを写真4.2に示す。
19
写真4.2 製作したライントレース/ランダム移動切り替えマウス
4−6 検討
ライントレース/ランダム切り替えマウス回路を実際に製作してわかったこと
は、ランダムモードの場合はフォトインタラプタの反応かプロセッサの方向転
換の指示が遅くて、ラインを横切った後に方向を転換した。ライントレースモ
ードの場合は白黒が明確に区別できなければ動作が不安定になった。フォトイ
ンタラプタ単体の動作確認は終えているので、プロセッサまで含めた総合的な
調整がライントレースの性能を大きく左右する。今回は時間の都合上、完全に
調整を行わなかった。あらゆるケースで完全に動作させるためには多くの動作
試験が必要であることがわかった。フォトインタラプタの間に黒い仕切りを設
けることで一応の動作は保障されたので、より完全な動作は今後の課題とする。
20
第 5 章 赤外線/無線切り替えリモコン走行車の
製作と動作確認
5−1実験の目的
実験の目的として、送信機から赤外線で信号を送信させ、受信された模型が
働くことにより、赤外線通信と無線通信の仕組みを学習する。そして、実際に
応用として、赤外線/無線切り替え走行車を製作する。
5−2 赤外線を用いた送受信回路の原理と問題点
赤外線通信は、テレビやビデオのリモコンに利用される。テレビのリモコン
は次図5.1に記述される送信フォーマットを受信機側に送信する。
(a)送信データフォーマットの構成
フレームリーダー部
データ部
8ビット(全てビット0) 16ビット
データ部(連送)
16ビット
(b) データ部の構成
1 C2
C1
C0
スタートビット デバイスコード
0
セパレータ
1 D4
D3
D2
D1
D0
スイッチコード 1
0
0
0
0
ストップシーケンス 図5.1 送信データフォーマット
21
送信機からの送信データフォーマットはデバイスコードとスイッチコードを指
定し、受信機に送信する。送信データを受信した受信機は、スタートビット、
デバイスコード、セパレータ、スイッチコード、ストップシーケンスを確認し
た後受信する。そして、再び送信データフォーマットを確認、受信し、最初に
受信した送信データフォーマットと照合し、一致していない場合は、受信機の
プログラムの最初に戻るという2連送照合をしている。
赤外線通信の問題点として、4∼5mの通信距離であるということが挙げら
れる。従って、赤外線通信は1部屋分の距離であるといえる。また、赤外線受
信部は、直射日光や蛍光灯の光にも反応してしまうので、誤動作を起こしやす
いという問題点がある。
5−3 FM電波を用いた送受信回路の原理と問題点
本実験に於いて、FM電波の送受信には、赤外線送受信と同様に図5.1の
データフォーマットを送信し、2 連送照合によりデータを受信する方式が採用さ
れた。FM電波は通信距離が約10mであるので、赤外線通信よりも通信距離
が優れている。
FM電波送受信回路の問題点として、他の変調方式に比べて広い周波数帯域
幅が必要になる性質がある。
5−4 応用例
5−4−1 赤外線/無線切り替えリモコン走行車の動作原理
赤外線送受信とFM無線送受信を学習するため、赤外線送信機と無線送信機
で動作するリモコン走行車を製作した。赤外線送信機と無線送信機を使い分け
るため、リモコン走行車はスイッチを切り替えることにより、赤外線受信機と
無線受信機が切り替る仕組みである。
22
まず、赤外線で送信するため、赤外線発光ダイオードを赤外線送信機に用い
た。赤外線送信機は、8つのスイッチで各動作をするよう設計された。そして、
赤外線受信機には、赤外線受光モジュールが用いられた。赤外線送信機からの
8つスイッチのうちのどれかを押すことにより、赤外線発光ダイオードを光ら
せ、その発光した間隔により、32つスイッチコードのどれかを赤外線受信モ
ジュールに送信する原理になっている。本実験に於いては、赤外線、無線送信
機の両方とも送信するデバイスコードを100に設定した。赤外線送信機と赤
外線受信機のデータフォーマットの送受信は、PIC16F84Aに書き込ま
れたプログラムで操作される。
次に、無線で送信するため、無線送信モジュールを、無線送信機に用いた。
無線送信機は、赤外線送信機と同様の構造と送信方式である。無線受信機には
無線受信モジュールが用いられた。無線受信機も、赤外線受信機と同様の構造
と受信方式である。
5−4−2 赤外線/無線切り替えリモコン走行車の回路製作
赤外線送信機は、ボタン配置が下図4.1のように設計された。
S4左速度UP
S0停止
S1右速度UP
00100
00000
00001
S5左減速
S3未使用
S2右減速
00101
00011
00010
S7左逆回転
S6右逆回転
00111
00110
図5.1 赤外線送信機のボタンの役割とスイッチコード
23
そして、下図5.2に赤外線送信機の回路図を記述する。ここで、赤外線送信
機は、赤外線発光ダイオードに60mAの電流が流れるように設計された。ス
イッチS1∼S7を押すことにより、PIC16F628に書き込まれたプロ
グラムが赤外線発光ダイオードD1にかかる電圧を操作している。
S9
+3V
R2
50
D1
LED1
R1
10k
R3
50
S8
U1
R4
50
C1
1uF
1 RA2
2 RA3
3 RA4
4 RA5
5 GND
6 RB0
7 RB1
8 RB2
9 RB3
S0
RA1 18
RA0 17
RA7 16
RA6 15
Vcc 14
RB7 13
RB6 12
RB5 11
RB4 10
XTAL1
4.000MHZ
S7
16f628
S6
S1
S5
S2
S4
S3
図5.2 赤外線送信機回路図
24
無線送信機は下図5.3のように設計された。PIC16F628に書き込
まれたプログラムで、無線送信モジュールU2のInに入力する電圧を操作し
ている。
EA
En
In
GND
S9
GND
Vcc
+3V
U2
R1
10k
C1
1uF
S8
U1
1 RA2
2 RA3
3 RA4
4 RA5
5 GND
6 RB0
7 RB1
8 RB2
9 RB3
S0
RA1 18
RA0 17
RA7 16
RA6 15
Vcc 14
RB7 13
RB6 12
RB5 11
RB4 10
XTAL1
4.000MHZ
S7
16f628
S6
S1
S5
S2
S4
S3
図5.3 無線送信機回路図
25
赤外線/無線切り替えリモコン走行車の受信回路は図5.4のように設計され
た。U8が赤外線受光モジュールで、U7がインバータである。無線受信モジ
ュールU2から受信された信号をU7に入力し、U7からの入力反転信号をP
IC16F84のRA4ポートに入力させている。赤外線と無線の受信切り替
えスイッチはS3である。
U2
U7
GND
NC
NC
OUT
En
1 P1
2 P2
3 P3
4 P4
5 P5
6 P6
7 P7
11
12
13
14
15
IN
7 GND
1 Vcc
2 GND
3
FM-RRFQ1-315
P14 14
P13 13
P12 12
P11 11
P10 10
P9 98
P8
74HC14
U3
S81350
S1
3 IN
GND
2
+6V
S3
C5
33uF
U8
Optorecv
OUT 3
R7
470
OUT 1
C6
100uF
16f84
Vs 2
1 RA2 RA1 18
2 RA3 RA0 17
3 RA4 osc1 16
4 nMCLRosc2 15
5 GND Vcc 14
6 RB0 RB7 13
7 RB1 RB6 12
8 RB2 RB5 1
9 RB3 RB4 10
GND 1
CRVP1738
XTAL1
10.000MHZ
U1
R1
3k
U9
R6
5k 40%
C7
R2
200
0.047uF
1 Vref
2 InB
3 InA
4 Cosc
5 NF
6 OutB
7 Vi
8 OutA
Gm 16
Gm 15
DA3 14
DA2 13
DA1 12
DA0 11
Vm 10
Gm 9
U5
1 Vref
2 InB
3 InA
4 Cosc
5 NF
6 OutB
7 Vi
8 OutA
TA7289P
C4
2.2uF
R4
2
R5
200
M1
C2
0.01uF
C1
0.047uF
Gm 16
Gm 15
DA3 14
DA2 13
DA1 12
DA0 11
Vm 10
Gm 9
TA7289P
R3
2
M2
C9
2.2uF
C3
0.01uF
図5.4 赤外線/無線切り替えリモコン受信回路図
26
D1
LED1
赤外線/リモコン切り替え走行車に、赤外線と無線送信機で送信したがうまく
動作せず、どこに原因があるかを確かめるために、ブレッドボードに図5.4
の赤外線受信部分を再現し(写真5.1)、8 桁 7 セグメント LED 表示装置を
用いて赤外線送信機の動作が正しく行われたかどうかを写真5.2から5.8
のように確認した。LEDを用いた動作確認回路はPIC16F84に書き込
まれたデータにより、点滅が変化する。図5.4のモータードライバーU9(左
動作)、U5(右動作)DA0からDA3に入力するPIC16F84のRB0
(LSB)からRB3(MSB)
、RB4(LSB)からRB7(MSB)が2
進数で表示される。速度が増加すると、その2進数の値も増加する。そして、
U9とU5モータードライバーの入力INA,INBに対応した、PIC16
F84のRA2とRA3ポートからの信号で、動作確認回路の LED が同時に点
灯すると、停止することを示している。
写真5.1 赤外線送信機の動作確認回路
写真5.2 赤外線送信機の左速度を上げたときの動作確認回路
27
写真5.3 赤外線送信機の左速度を下げたときの動作回路
写真5.4 赤外線送信機の左逆回転させたときの動作回路
28
写真5.5 赤外線送信機の右速度を上げたときの動作確認回路
写真5.6 赤外線送信機の右速度を下げたときの動作回路
29
写真5.7 赤外線送信機の右逆回転させたときの動作回路
写真5.8 赤外線送信機の停止状態のときの動作回路
30
無線送信機からの信号も、赤外線送信機と同様にBreadboadに
回路を組み込んで動作を確認した。その動作の様子は写真5.9から5.16
である。
写真5.9 無線受信機の動作確認回路
写真5.10 無線送信機の左速度を上げたときの動作確認回路
31
写真5.11 無線送信機の右速度を下げたときの動作回路
写真5.12 無線送信機の左逆回転させたときの動作回路
32
写真5.13 無線送信機の右速度を上げたときの動作確認回路
写真5.14 無線送信機の右速度を下げたときの動作回路
33
写真5.15 無線送信機の右逆回転させたときの動作回路
写真5.16 無線送信機の停止状態のときの動作回路
34
ブレッドボードで、赤外線と無線の送信確認回路を用いて赤外線/無線送信機の
動作を確認した結果、正常に動作することが確認された。
次に、赤外線送信機の送信データフォーマットの受信を確認するため、赤外
線送信機の波形をデジタルオシロスコープで確認した。そのようすは写真5.
17と写真5.18になり、送信データフォーマットが正確に送信されている
ことが確認された。ここでの信号波形はPICに書き込まれたプログラムのた
め0と1が逆転している。
S0 S1
S2 S3
写真5.17 赤外線送信機出力波形1(X軸のリードアウト表示はスイッチ
コード)
35
S4 S5
S6 S7
電源入力時のノイズ
写真5.18 赤外線送信機出力波形2
36
そして、無線送信機の送信データフォーマット確認するため、図5.3の回
路においてPIC16F628のRA2端子の信号波形を観測した。赤外線送
信機と同様に無線送信機の送信データフォーマットは、正確に送信されている
ことが確認された。写真5.19と写真5.20はデジタルオシロスコープを
用いて観測されたようすである。
S0 S1
S2 S3
写真5.19 無線送信機出力波形1(X軸のリードアウト表示はスイッチコ
ード)
37
S4 S5
S6 S7
写真5.20 無線送信機出力波形2
38
次に受信波形を示す。最初に赤外線検出器の場合である。赤外線受信部はノ
イズの影響を受けやすく、受信された送信データフォーマットのようすをデジ
タルオシロスコープで観察した。写真5.21、写真5.22にその様子を示
す。ノイズ源は主として蛍光灯や家庭の AC コンセントである。図5.4のP
IC16F84のRA4ポートの信号はデジタルオシロスコープで観測された。
観測時にはノイズの影響を受けやすかった。
S0 S1
S2 S3
写真5.21 赤外線受信機出力波形1(X軸のリードアウト表示はスイッチ
コード)
39
S4 S5
S6 S7
電源入力時のノイズ
写真5.22 赤外線受信機出力波形2
40
FM 無線受信部は蛍光灯の影響は受けないものの、送信機からの出力がない時
には非常に多くのノイズを出す。このノイズが受信信号に乗るときがあり、時
にはノイズ信号が先に検出され、受信した送信データフォーマットが全く測定
出来ない時間があった。最初は74HC04を用いて1回反転することでノイズ
を軽減しようとしたのだが、あまりうまくいかないので、ノイズ対策用として
アクティブフィルターを用いることとした。下図5.5は本実験で用いたアク
ティブフィルタ回路である。ここで、抵抗R1、R2、R3と、コンデンサC
1、C2、C3の値は次式(5-1)、(5-2)、(5-3)を用いて定められた。
カットオフ周波数はデジタルオシロスコープで観測した最も低周波側に存在す
るノイズである1.2kHzを十分に遮断し、しかも送信機の600Hz を遮断
しない1kHzとした。図5.5のアクティブフィルターを回路シュミュレーシ
ョンすると設計通りの結果になった。
1
2 ⋅π ⋅
f
=
f
(5-1)
1
= R1 ⋅ C 3 (5-2)
c
1
2 ⋅ 2 ⋅π ⋅
3
c
2
2 ⋅π ⋅
R ⋅C
f
=
R ⋅C
2
2
(5-3)
c
Vcc
5V
+V
C3
22nF
A
R3
7.2k
R1
14.4k
+
R2
14.4k
+
B
U2B
U2A
Vin
0/5V
LM2902/NS
LM2902/NS
R6
10k 40%
C1
C2
5.4nF
2.2nF
1kHz
図5.5 アクティブフィルター回路
41
+
U2C
LM2902/NS
C
ここで、アクティブフィルターに搭載されたオペアンプとして、NJM290
2Nか LMC660CN、LM324のどれかを使うこととし、実際それらの性能を
比較してみた。ここで LM324は一般の単電源オペアンプで、NJM2902 は
LM324 よりもスルーレートが向上しており、比較的パルス信号に強いタイプで、
LMC660CN は単電源かつレールトゥーレールのオペアンプである。Bre
adboadに図5.5のアクティブフィルター回路を再現し、どのをオペア
ンプを採用するかを決定する。まず、NJM2902Nを用いたときの、B点と
C点の波形をデジタルオシロスコープで観測した。そのときの入力周波数を 1
kHzごと変化させると同時に、最終段のコンパレーターの比較電圧を決定す
る可変抵抗R6にかかる電圧を変化させ、それをデジタルオシロスコープで観
測した。ここで、図5.5の可変抵抗の電圧は、その出力信号波形の1と0の
周期が等しかった3.0Vと3.5Vで観測した。
写真5.23 NJM2902Nを用いたアクティブフィルター回路
1kHz 2kHz.
3kHz 3.36kHz
写真5.24 図5.5に NJM2902Nを用いた可変抵抗電圧3
Vにおける B 点の波形
42
1kHz 2kHz
3kHz 4.42kHz
写真5.25 図5.5に NJM2902Nを用いた可変抵抗電圧3Vにおける
C点の波形
43
1kHz 2kHz
3kHz 3.6kHz
写真5.26 図5.5に NJM2902Nを用いた可変抵抗電圧3。5Vにお
けるB点の波形
44
1kHz 2kHz
3kHz 3.6kHz
写真5.27 図5.5に NJM2902Nを用いた可変抵抗電圧3.5Vにお
けるC点の波形
45
次に NJM2902Nと同様の実験をLMC660CN で試みた場合は、1kH
zから2kHz ではアクティブフィルターとして機能するが、2kHz以上の周
波数では逆に波形が入力波形と一致し、レールトゥレールのありがたさよりも
高周波特性の悪さが目だって使い物にならなかった。
最後にアクティブフィルターのオペアンプとして LM324 を使うことを考える。
写真5.28にアクティブフィルターを組んだブレッドボードの写真を、写真
5.29にコンパレータの閾値電圧として3.0V を設定したときの1kHz か
ら4.8kHz の出力波形と写真5.30にコンパレータ通過後の反転波形をし
めし、写真5.31と写真5.32にコンパレータの閾値電圧を3.5V とし、
アクティブフィルターを通過後の波形とコンパレータ通過後の波形を示す。
写真5.28 LM324を用いたアクティブフィルタ回路
46
1kHz 2kHz
3kHz 4.8kHz
写真5.29 図5.5にLM324を用いた可変抵抗電圧3VにおけるB点
の波形
47
1kHz 2kHz
3kHz 3.9kHz
写真5.30 図5.5にLM324を用いた可変抵抗電圧3VにおけるC点
の波形
48
1kHz 2kHz
3kHz 4kHz
4.83kHz
写真5.31 図5.5にLM324を用いた可変抵抗電圧3.5Vにおける
B点の波形
49
1kHz 2kHz
3kHz 3.41kHz
写真5.32 図5.5にLM324を用いた可変抵抗電圧3。5Vにおけ
るC点の波形
50
図3.5のB点とC点における、オペアンプ2902NとLM3241と0
の周期は、表5.1と5.2のように観測された。また、入力に対して出力が
LM324 を使ったときのほうが低い周波数で消失した。フィルターとしては1k
Hz 以上の周波数ではより早く減衰するほうが望ましいので、今回は LM324 を
使用することとした。そこでLM324を用いたアクティブフィルターを図5.
4の回路に追加した。その回路図を図5.6に示す。
1kHz
2khHz
3kHz
HIGHの間隔(ms) LOWの間隔(ms)
1kHz
0.5
0.48
2kHz
0.27
0.22
0.2
0.14 3kHz
HIGHの間隔(ms) LOWの間隔(ms)
0.56
0.46
0.3
0.18
0.24
0.1
可変電圧3V 可変電圧3.5V
表5.1 NJM2902NのHighとLowの間隔
1kHz
2kHz
3kHz
HIGHの間隔(ms) LOWの間隔(ms)
1kHz
0.49
0.46
2kHz
0.25
0.22
0.17
0.12 3kHz
HIGHの間隔(ms) LOWの間隔(ms)
0.56
0.45
0.27
0.19
0.23
0.11
可変電圧3V 可変電圧3.5V
表5.2 LM324のHighとLowの間隔
51
U2
11 GND
12 NC
13 NC
14 OUT
15 En
IN
7 GND
1 Vcc
2 GND
3
FM-RRFQ1-315
U3
S81350
S1
3 IN
2
+6V
S3
C5
33uF
U8
Optorecv
OUT 3
R7
470
OUT 1
GND
C6
100uF
16f84
Vs 2
GND 1
1 RA2
RA1 18
2 RA3
RA0 17
3 RA4 osc1
16
4 nMCLRosc2 15
5 GND
Vcc 14
6 RB0
13
RB7
7 RB1
RB6 12
8 RB2
RB5 1
9 RB3
RB4 10
CRVP1738
XTAL1
10.000MHZ
U1
R1
3k
U9
R6
5k 40%
1 Vref
2 InB
3 InA
4 Cosc
5 NF
6 OutB
7 Vi
8 OutA
C7
R2
200
0.047uF
Gm 16
Gm 15
DA3 14
DA2 13
DA1 12
DA0 11
Vm 10
Gm 9
U5
1 Vref
2 InB
3 InA
4 Cosc
5 NF
6 OutB
7 Vi
8 OutA
TA7289P
C4
2.2uF
R4
2
R5
200
C1
0.047uF
M1
C2
0.01uF
TA7289P
R3
2
M2
C9
2.2uF
Vcc
5V
+V
Gm 16
Gm 15
DA3 14
DA2 13
DA1 12
DA0 11
Vm 10
Gm 9
C3
0.01uF
C11
22nF
R11
7.2k
R9
14.4k
+
R10
14.4k
+
+
U4C
LM2902/NS
U4B
U4A
LM2902/NS
LM2902/NS
C8
2.2nF
R8
10k 40%
C10
5.4nF
図5.6 赤外線/無線切り替えリモコン走行車の修正回路
52
D1
LED1
最後に LM324 を用いてアクティブフィルターを実装した図5.6の回路に対
してその受信波形をデジタルオシロスコープを用いて観測した。結果を写真5.
33、写真5.34に示す。正常に FM 無線送信機からの送信データフォーマ
ットが受信されていることがわかった。
S0 S1
S2 S3
写真5.33 図5.6の回路の赤外線受信信号1
53
S4 S5
S6 S7
写真5.34 図5.6の回路の赤外線受信信号2
54
5−5 実験回路の動作確認
本実験の赤外線/無線切り替えリモコン走行車において、オペアンプLM32
4によるアクティブフィルタ回路を追加することにより、赤外線受信部のノイ
ズによる誤動作を防ぐことに成功した。そして、赤外線/無線切り替えリモコン
走行車は赤外線送信機の各スイッチに対し、正確に動作することが確認された。
作製した赤外線/無線切り替えリモコン走行車と赤外線リモコン送信機、FM 無
線リモコン送信機を写真5.35、写真5.36、写真5.37に示す。
写真5.35 製作した赤外線/無線切り替えリモコン走行車
写真5.36 赤外線リモコン送信機 写真5.37 無線リモコン送信機
55
5−6 検討
赤外線/無線リモコン切り替え走行車を製作してわかったことは、赤外線通信
と無線通信には一長一短があることである。アクティブフィルターを使用しな
ければ、回路の製作においてはどちらもそれほど難しくはない。しかしながら
アクティブフィルターを使用しなければ無線通信は事実上使い物にならず、赤
外線通信のほうがましであった。純粋に赤外線通信と無線通信を比較してみる
と、移動するリモコン走行車に対してはデータの取りこぼしが少ない分無線通
信のほうが有利に感じられた。通信可能距離は赤外線通信で約1mで、無線通
信で約1m50cmで、若干無線通信のほうが遠くまで通信できた。当初の予
定よりも大幅に通信可能距離が短くなった原因は今のところ不明であるが、現
状のパルスでデータを送信する方式ではこの程度しか通信できないのかもしれ
ない。いずれにしても通信距離を大幅に延ばすことと、データの取りこぼしの
確率を減らしてほとんど完璧に命令を実行できるようにすることが今後の課題
である。
56
第6章 加速度センサを用いた角度検出回路の
設計と製作
6−1 実験の目的
本実験では、動きに反応するセンサである加速度センサの働きについて学ぶ
ため、角度検出器を製作することを目的とする。角度検出器は、PIC16F
628に書き込まれたプログラムにより、左右上下に動かした加速度センサか
らの信号を読み取り、7セグメントLEDに角度情報として出力する。
6−2加速度センサを用いた角度検出回路の原理
Vdd
加速度センサの働きは、X軸とY軸方向に動かすことにより、それぞれの加
速度を検知し、それをパルス信号の形で出力することである。下図6.1に加
速度センサを示す。図6.1の加速度センサは、XfiltとYfiltで、
それぞれ、X軸とY軸の加速度を読み取る。そして、XoutとYoutで、
検知した加速度をパルス信号で出力する。
Xfilt
Yfilt
Xout
Yout
ST
T2
COM
図
6.1 加速度センサ
6−3 ダイナミック点
灯方式について
57
本実験では、角度検出器の出力信号の表示には下図6.2の 7 セグメントL
EDを X 軸に対して 3 個と Y 軸に対して3個の計6個を使用した。この素子は、
aから dp のどれかに電流を流すことにより、0から9までの数字が表示される
仕組みになっている。しかし、3つの7セグメントLEDに全てに電流を流し
た場合、PIC16F628のピンの数を超えるので、角度検出器にはダイナ
ミック点灯制御方式が採用された。これは、PICに書き込まれたプログラム
により短時間に1つの桁を点灯、消灯して、3桁表示させる方式である。この
方式を用いると、数 10ms 周期の信号を7セグメントLEDに送ると、肉眼で
は連続にその各桁が点灯しているように見えるのである。
a
b
c
d
e
f
g
dp
図6.2 7セグメントLEDカソードコモンタイプ
6−4応用例
6−4−1 角度測定器の動作原理
本実験で製作された角度測定器に組み込まれた加速度センサは、前後、左右に
倒すことで、パルス波である出力信号の1の間隔を変化させる。そして、角度
検出器に用いられた7セグメントLEDが出力信号1の間隔を表示するのであ
58
る。本実験では、PIC16F628に書き込まれたプログラムにより、加速
度センサから出力されるパルス波の周期は約6.0msに設定された。
6−4−2 角度検出器の製作
本実験で製作された角度検出器の回路図は図6.3である。
R7
1MEG 1 ST
2
ADXL202E
C3
1uF
Vdd 8
U2
S1
Xfilt 7
Yfilt 6
Xout 5
4 Yout
T2
3 COM
C2
0.1uF
+3V
C1
0.1uF
U1
R8
120
R9
120
RA2
RA3
RA4
RA5
GND
RB0
RB1
RB2
RB3
R3
3.9k
RA1
RA0
RA7
RA6
Vcc
RB7
RB6
RB5
RB4
16f628
R2
3.9k
Q3
2SC1815
R1
3.9k
Q2
2SC1815
Q1
2SC1815
R14
120
Gnd
R13
120
Gnd
Gnd
DISP2
DISP3
R12
120
abcdefg.
DISP1
abcdefg.
abcdefg.
R10
120
R11
120
R6
3.9k
R5
3.9k
Q6
2SC1815
Gnd
Q5
2SC1815
R4
3.9k
Gnd
DISP6
abcdefg.
Q4
2SC1815
Gnd
DISP5
abcdefg.
DISP4
abcdefg.
図6.3 角度測定器の回路図
図6.3の回路図の加速度センサADXL202Eに接続された抵抗R7と
コンデンサC1,C2には、厳密な測定でない故に標準的な数値を用いて設計
59
された。また、抵抗R8からR14までの抵抗120Ωは、各 7 セグメント LED
の入力に約8mAの電流が流れるよう設計された結果である。そして、R1か
らR6の抵抗は、1つの7セグメントの全てのエレメントが点灯した場合の電
流が、NPN型トランジスタQ1からQ6で100倍に増幅した場合、60m
Aになるように、3.9kΩに設計された。図6.3で用いられたPICには、
RA0、RA1、RA2,RA3、RA6、RA7には点灯させる7セグメン
トの選択をさせ、RBポート全てに、その表示する数字を選択するようにプロ
グラムが書き込まれた。
6−5実験回路の動作確認
角度検出器の働きを観測するため、実際にそれを前後、左右に倒した場合の、
加速度センサからの出力波形を、デジタルオシロスコープを用いて調べた。こ
こでの観測波形は、回路図6.3の加速度センサ ADXL202E の Xout から X 軸
の出力波形が現れ、Yout から Y 軸の出力波形が現れるので、それらをモニター
した。その様子を写真6.1から6.3に示す
実際の測定写真 X 軸0°傾斜の Y 軸0°傾斜の
Xout 出力波形 Yout 出力波形 3.
45ms 3.61ms
写真6.1 角度検出器 X,Y軸0°の場合の出力1の間隔
60
実際の測定写真(X 軸90°傾斜) X 軸90°傾斜の Xout 出力波形
4.06ms
実際の測定写真(X 軸―90°傾斜) X 軸−90°傾斜の Xout 出力波形
2.97ms
写真6.2 角度検出器を X 軸方向に90°、−90°(加速度センサ4、
1ピン方向が X 軸)に傾けた場合の出力信号1の間隔
61
実際の測定写真(Y 軸90°傾斜) Y 軸90°傾斜の Xout 出力波形
4.21ms
実際の測定写真(Y 軸―90°傾斜) Y 軸−90°傾斜の Yout 出力波形
3.17ms
写真6.3 角度検出器を Y 軸方向に90°、−90°(加速度センサ4、
5ピンは Y 軸方向)に傾けた場合の出力1の間隔
以上の結果を元に角度測定器を製作した結果、加速度センサの出力信号波形
の1(high)の間隔の変化が7セグメント LED の3桁の数字の形で表示される
ことになった。観測された。これを写真6.4に示す。
62
写真6.4 製作した角度検出回路
6−6 検討
本研究を通して加速度センサの基本的な使い方を習得し、応用回路として角
度検出器を設計・製作したが、当初の設計どおりの水平の位置で4ms、+9
0°の位置で5ms、−90°の位置で3msから出力がずれてしまった。こ
の原因はパルス幅を決める外付けの抵抗とコンデンサの精度によるものと考え
ているが、明確なことはわからない。いずれにしても、現状で発生するパルス
幅を基準として第7章のロボットアームを製作したが、より角度条件の厳しい
回路に於いては今回のとりあえず角度検出部分を製作してその結果から次の回
路を製作するという方法は問題を発生させる可能性を有する。角度条件が厳し
い場合は当初の設計どおりのパルス幅を出力するまで設計を追い込む必要があ
ることをここに記しておく。
63
第7章 加速度センサ、FM 電波送受信回路、
モーターコントロール回路を組み合わせ
た回路の製作
7−1 実験の目的
本実験の目的として、第4章に記述された回路のモーター制御部分と第5章
に記述された回路の FM 電波送受信部分、そして、第6章に記述された回路の
加速度センサ部分を用いて、いままでの実験の集大成として、動きのある模型
を製作する。
7−2実験回路の製作
7−2−1 ロボットアーム送受信回路の動作原理
本実験では動きのある模型として、ロボットアーム送受信器が製作された。
これは、予め市販されているリモコンロボットアームのモーター制御回路に、
本実験で製作されたロボットアーム受信回路を組み込むことにより、送信回路
の動きにあわせてロボットアームが上下左右に動作をする仕組みである。
ロボットアームの送信回路には、第5章で記述された無線送信モジュールと
第6章の回路製作で記述された加速度センサが用いられた。その送信回路は、
ロボットアーム回路に信号を送信するため、加速度センサで検出された信号を
PIC に入力させ、それに書き込まれたプログラムにより無線送信機が出力信号
を送信する仕組みになっている。
ロボットアームの受信回路には、第4章で記述されたモータードライバーと
64
第5章で記述された無線受信モジュールと雑音対策のためのアクティブフィル
タ回路が用いられた。その受信回路は、無線送信モジュールでロボットアーム
送信機からの信号を受信し、アクティブフィルタ回路に入力される。そして、
アクティブフィルタ回路から出力した信号が PIC に入力され、予め PIC に書き
込まれたプログラムによりモータードライバーへの信号を制御する仕組みとな
っている。
7−2−2 ロボットアーム送受信回路の製作
ロボットアーム送信機の回路図を下図7.1に示す。この図7.1の回路は、
加速度センサ ADXL202E からの出力信号 Xout、Yout を PIC12F629に入力
し、その PIC に書き込まれたプログラムにより制御された出力信号が無線送信
モジュール FM-RTFQ1−315の In に入力されるよう設計された。その PIC
に書き込まれたプログラムは、第6章で記述されたように加速度センサ X 軸と
Y 軸のそれぞれを0°、90°、-90°傾けた3通りにより出力パルス1の間
隔は変化する。そのことを用いてそれぞれ3通りの動作をロボットアームにさ
せるようそのプログラムは作成された。図7.2に、ロボットアーム送信機か
らの送信データフォーマット、図7.3にそのスイッチコードを示す。
S1
+3V
FM-RTFQ1-315 U2
EA
En
In
GND
GND
Vcc
12F629 U3
XTAL1
4.000MHZ
VDD
OSC1
OSC2
GP3
GND
GP0
GP1
GP2
Vdd
U1
ADXL202E
ST
T2
COM
Xfilt
Yfilt
Xout
Yout
R1
1MEG
C2
0.1uF
C1
0.1uF
7.1 ロボットアーム送信機の回路図
65
1
1
0
スタートビット デバイスコード
1
0
1
1 D3 D2 D1 D0
セパレータ
スイッチコード 1
0
0
0
0
ストップシーケンス 図7.2 ロボットアーム送信機の送信データフォーマット(データ部)
D3 D2
ー90° 0 1
0° 1 1
90° 1 0
加速度センサ Y 軸傾斜によるスイッチコード
D1 D0
ー90° 0 1
0° 1 1
90° 1 0
加速度センサ X 軸傾斜によるスイッチコード
図 7.3 加速度センサ X 軸 Y 軸のスイッチコードの割り当て
66
ロボットアーム受信機の回路図を下図7.4に示す。この回路では、第5章
で製作された無線送信部分とアクティブフィルター部分を同じように搭載した。
また、抵抗 R9,10,11,12 の値は、トグルスイッチ S9からの電圧を抵抗 R9 と
R10 間、R11 と R12 間で約5V になるようにするために挿入したものである。
また、そのスイッチからの電圧は、出力電圧を一定に保つ3端子レギュレータ
ーS81350 により5V とされ、その電圧はオペアンプ LM324 と無線受信モジュ
ール、PIC16F628 の電源電圧とされる。そして、抵抗 R4、R5 は発光 LED
に電流を約8mA流れるよう設計された。この回路の受信順序として、ロボット
アーム送信回路からの信号を無線受信モジュールで受信し、その OUT からの出
力信号がアクティブフィルターを通り、PIC16F628 に入力される。そして、そ
の PIC に書き込まれたプログラムにより、モータードライバーIN1、IN2の出
力信号は制御される。また、そのプログラムは、ロボットアーム送信データフ
ォーマットからの信号を第5章に記述したように、2連送照合して受信するよ
う作成された。
U2
FM-RRFQ1-315
IN
GND
NC
NC
OUT
En
Vcc
GND
M1
GND
S1
D2
LED2
S2
U1
R4
390
RA2
RA3
RA4
RA5
GND
RB0
RB1
RB2
RB3
D1
LED2
S3
RA1
RA0
RA7
RA6
Vcc
RB7
RB6
RB5
RB4
A
XTAL1
10.000MHZ
R1
14.4k
+
R3
7.5k
U6A
C3
22nF
R2
14.4k
C1
R5
390
2.2nF
S4
M4
R7
470
D3
LED2
R14
470
R8
470
R15
470
D6
LED2
D4
LED2
D7
LED2
C4
0.1uF
S5
C7
0.1uF
U4
R9
200
V1
3V
GND
MC1
NC
Vref
IN1
IN2
Vcc
Vs
NC
MC2
TA7291P
S9
+
U5
M2
GND
MC1
NC
Vref
IN1
IN2
Vcc
Vs
NC
MC2
M3
R10
820
+ V2
3V
R11
200
R12
820
B
U6B
LM324
LM324
16f628
M5
+
TA7291P
U3
S81350
IN
OUT
R13
470
D5
LED2
GND
図7.2 ロボットアーム受信回路図
67
C2
2.2nF
R6
10k 40%
U6C
LM324
+
C
7.3 実験回路の動作確認
実際にロボットアーム送受信回路を製作した結果、ロボットアーム送信機の
加速度センサの X 軸、Y 軸の動きに合わせてロボットアームのアーム部分が前
後、左右に動くことが確認された。製作したロボットアーム送信部と受信部を
写真7.1に示す。
写真7.1 製作したロボットアーム送信部と受信部
7−4 検討
第7章ではいままでの総まとめとして腕に取り付けたリストバンドに加速度
センサを搭載することによって、腕の角度を検出し無線でロボットアームに取
り付けた受信機に信号を送信する回路を製作した。角度の信号が正確に送信さ
68
れ、受信されているかどうかを確かめるために4個の LED を用いて受信コード
の主要部分である下位4ビットを表示させることとした。送信機には送信デー
タを確認するためにデジタルオシロスコープのプローブを付け、送受信間でど
こに問題があるのかを何度も確認した。受信回路はノイズをある程度減衰させ
るアクティブフィルターを搭載しており、第5章の赤外線/無線切り替えリモコ
ン走行車の製作経験から1m以内の距離では確実にデータが受信できるはずで
あった。しかしながら、受信機に対して送信機の位置関係が変わることによっ
てそれほど距離が変わっていないにもかかわらず送信データを取りこぼす場合
が時々見受けられた。この原因は不明であるがロボットアームから製作した回
路が外にはみ出さないように無理して実装したことによるのかもしれない。ロ
ボットアームの空きスペースは相当少なく、配線やそれぞれの部品にいろいろ
な圧力がかかっている。このような状況下でも確実に動作させるためにはかな
りの技術と経験が必要であると痛感した。
69
第8章 まとめ・感想
本研究では、PIC プロセッサの基礎的な構造とプログラムを学ぶことから始
めた。そして、センサに着目し、その仕組みを学び、それを活かした回路を作
製した。まず、第4章では、PIC を用いたセンサ回路を製作した。ここでは、
フォトインタラプタの動作を確認する際、ソフトやハードの面のどちらかに誤
りがあるのかどうかということを調べることに大変試行錯誤した。次に第5章
では、信号の送受信が困難になることが起こり、ブレッドボードにその一部の
回路を製作し確認する等の方法を行ったが、受信側の問題箇所が分からず、非
常に難儀であった。そこで、アクティブフィルター回路を用いた結果、それな
りに動作をしたが、思い描いた動作でない所に心残りがあった。しかし、第5
章の回路で非常に躓いたことにより、一層 PIC プロセッサの応用の広さを実感
した。そして、第6章では、動きを読み取るセンサを学ぶため、角度検出器を
設計した。ここでは、回路の配線が非常に複雑で、幾度も導通確認を行った。
最後に本研究の集大成として、ロボットアーム送受信回路を製作した。この回
路では、もともとのロボットアームの真下の空きスペースに基板を組み込む際
に切断などをして実装するまでが大変苦労した点が印象に残った。
以上の実験を通して、センサと PIC プロセッサの知識を学習した。そして、
これからの人生に於いて本研究で製作した経験はかけがえのないものになるで
あろうと思った。
70
参考文献
1)後閑哲也著『ロボット改造工作マニュアル』(技術評論社)
2)後閑哲也著『電子工作のための PIC 活用ブック』(技術評論者)
3)遠藤敏夫著『PIC マイコン製作集』(誠文堂新光社)
4)後閑哲也著『たのしくできる PIC 電子工作』(東京電機大学出版局)
5)堀桂太郎著『図解 PIC マイコン実習』(東北出版株式会社)
6)中尾真治著『おもしろい PIC マイコン12F675を使いこなす』
(オーム社)
7)河西真史 共著『PIC マイコンによるメカトロニクス入門』(CQ 出版社)
山本健一
鶴見恵一
71
謝辞
本研究ならびに論文の作成に当たり、終始親切で丁寧なご指導、ご支持を承
りました高知工科大学電子・光システムコース綿森道夫助教授に深い感謝の意
を表します。本論文は綿森助教授のお蔭で完成したといっても過言ではありま
せん。
また高知工科大学電子・光システムコース在学中、本研究の実験遂行、各過
程で終始ご厚意、ご協力頂きました高知工科大学電子・光システムコース長神
戸宏教授、河津哲教授、原央教授、矢野政顕教授、木村正廣教授、河東田隆教
授、成沢忠教授、岩下克教授、八田章光教授、橘昌良助教授、野中弘二助教授、
山本真行講師、植田和憲講師、杉田彰久教育講師、武田光由教育講師、西田謙
助手の方々には重ねて感謝の意を述べさせて頂きます。
72
Fly UP