QDセンサによる位置検出
4分割フォトダイオードを使って光源の2次元変位を計測します。
ソースコードやプロジェクトファイルのダウンロードはこちら →qd.zip
| ブロック図 |  | |||||||||||||||||
|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|---|
| プログラム |
proc
{
q0 = Ain( 0, 0, 1 );
q1 = Ain( 1, 0, 1 );
q2 = Ain( 2, 0, 1 );
q3 = Ain( 3, 0, 1 );
Z = q0 + q1 + q2 + q3; // 全光量
X = (-q0 + q1 + q2 - q3 ) / Z; // 変位 X
Y = ( q0 + q1 - q2 - q3 ) / Z; // 変位 Y
Aout( 0, 0, 1, X );
Aout( 1, 0, 1, Y );
Aout( 2, 0, 1, Z );
} | |||||||||||||||||
| 説明 |
4つのフォトダイオードの発生する光電流をOpアンプで電圧に変換し、アナログ電圧として入力します。
これらの和と差を演算すれば、２次元の変位に比例した信号になります。
以下の関数、信号、パラメータを使っています。
|