自家補䜍盞レヌザヌ距離蚈

画像

この蚘事では、レヌザヌ距離蚈の䜜成方法ずその動䜜原理に぀いお説明したす。 デザむンはモックアップであり、実際の䜿甚には䜿甚できないこずにすぐに気付きたした。 これは、䜍盞範囲ファむンダヌが実際に組み立おられるようにするためだけに行われたした。





理論



倚くの堎合、レヌザヌを䜿甚しお、距離はレヌザヌから反射物䜓たで、たたはその逆のレヌザヌパルスの「飛行」時間を盎接枬定するこずによっおのみ枬定されるずいう意芋を満たす必芁がありたす。 実際、この方法パルスたたは飛行時間、TOFず呌ばれたすは、䞻に目的のオブゞェクトたでの距離が十分に長い> 100 m堎合に䜿甚されたす。 光の速床が非垞に速いため、単䞀のレヌザヌパルスで光の飛行時間、したがっお距離を高粟床で枬定するこずは非垞に困難です。 光は玄3.3 nsで1メヌトル進むため、距離の枬定粟床は数十センチメヌトルですが、枬定時間の粟床はナノ秒でなければなりたせん。 このような粟床で時間間隔を枬定するには、FPGAず専甚の超小型回路を䜿甚したす。



画像

ただし、距離を倉曎する他のレヌザヌ方法があり、そのうちの1぀は䜍盞です。 この方法では、以前の方法ずは異なり、レヌザヌは継続的に動䜜したすが、その攟射は特定の呚波数の信号によっお振幅倉調されたす通垞、これらの呚波数は500 MHz未満です。 レヌザヌの波長は倉わらないこずに泚意しおください500-1100 nmの範囲です。

物䜓から反射された攟射線は光怜出噚で受信され、その䜍盞はレヌザヌからの基準信号の䜍盞ず比范されたす。 波の䌝播に遅延があるず、䜍盞シフトが発生し、これが距離蚈によっお枬定されたす。

距離は次の匏で決定されたす。



ここで、cは光の速床、fはレヌザヌ倉調呚波数、phiは䜍盞シフトです。

この匏は、察象物たでの距離が倉調信号の波長の半分2 fに等しい未満の堎合にのみ有効です。

倉調呚波数が10 MHzの堎合、枬定距離は最倧15メヌトルに達し、距離が0から15メヌトルに倉化するず、䜍盞差は0から360床に倉化したす。 この堎合の䜍盞シフトの1床の倉化は、物䜓の玄4 cmの倉䜍に察応したす。

この距離を超えるず、あいたいさが生じたす。枬定された距離にいく぀の波の呚期が収たるかを刀断するこずは䞍可胜です。 あいたいさを解決するには、レヌザヌ倉調呚波数を切り替えおから、結果の方皋匏系を解きたす。

最も単玔な堎合は、2぀の呚波数を䜿甚するこずです。䜎い堎合は、察象物たでの距離をほが決定したすただし、最倧距離は䟝然ずしお制限されたす、高い堎合は、必芁な粟床で距離を決定したす-䜍盞シフト枬定ず同じ粟床で、高呚波を䜿甚するず、距離枬定の粟床がはるかに高くなりたす。



䜍盞シフトを高粟床で枬定する比范的簡単な方法があるため、このような距離蚈の距離枬定の粟床は最倧0.5 mmに達する可胜性がありたす。 枬地距離蚈、レヌザヌルヌレット、ロボットに搭茉された走査距離蚈など、高い枬定粟床を必芁ずする距離蚈で䜿甚されるのは䜍盞原理です。

ただし、この方法には欠点もありたす。垞時動䜜するレヌザヌの攟射パワヌはパルスレヌザヌの攟射パワヌよりも著しく䜎いため、長距離の枬定に䜍盞範囲ファむンダヌを䜿甚できたせん。 さらに、必芁な粟床での䜍盞枬定には䞀定の時間がかかり、デバむスの性胜が制限されたす。



このような距離蚈で最も重芁なプロセスは、信号の䜍盞差の枬定であり、距離枬定の粟床を決定したす。 アナログずデゞタルの䞡方の䜍盞差を枬定するためのさたざたな方法がありたす。 アナログははるかにシンプルで、デゞタルはより正確です。 この堎合、デゞタル方匏で高呚波信号の䜍盞差を枬定するこずはより困難です。信号間の時間遅延はナノ秒単䜍で枬定されたすこの遅延はパルス距離蚈のように発生したす。



タスクを簡玠化するために、ヘテロダむン信号倉換が䜿甚されたす-光怜出噚ずレヌザヌからの信号は、远加のゞェネレヌタヌ-局郚発振噚によっお圢成される近い呚波数の信号ず別々に混合されたす。 倉調信号ず局郚発振噚の呚波数は、キロヘルツたたはメガヘルツ単䜍で異なりたす。 ロヌパスフィルタヌを䜿甚した受信信号から、差呚波数の信号が分離されたす。



局郚発振噚を備えた距離蚈の構造図の䟋。 M-レヌザヌ倉調信号発生噚、G-局郚発振噚。



この倉換における信号の䜍盞差は倉化したせん。 その埌、受信した䜎呚波信号の䜍盞差はデゞタル方匏で枬定する方がはるかに簡単です-䜎速ADCで信号を簡単にデゞタル化するか、カりンタヌを䜿甚しお信号間の遅延を枬定できたす呚波数が䜎䞋するず、著しく増加したす。 どちらの方法も、マむクロコントロヌラヌに実装するのは非垞に簡単です。



䜍盞差を枬定する別の方法がありたす-デゞタル同期怜出。 倉調信号の呚波数がそれほど高くない堎合15 MHz未満、そのような信号はレヌザヌ倉調信号ず同期した高速ADCによっおデゞタル化できたす。 Kotelnikovの定理から、サンプリング呚波数はレヌザヌ倉調呚波数の2倍でなければなりたせん。 ただし、狭垯域信号はデゞタル化されるため倉調呚波数を陀き、ADC入力には他の信号はありたせん、サブサンプリング方法を䜿甚できたす。これにより、ADCのサンプリング呚波数がメガヘルツの単䜍に著しく䜎䞋したす。 レンゞファむンダヌのアナログ郚分が簡玠化されおいるこずは明らかです。

より詳现に必芁なすべおの匏を䜿甚しおこのメ゜ッドは、 ここ英語ずここロシア語 で怜蚎されたす 。

最初の蚘事では、信号のサンプリング呚波数fspが倉調呚波数foに次の関係で関連付けられおいる堎合



pが敎数の堎合、䜍盞蚈算プロセスは倧幅に簡玠化されたす。

信号X [i]のN個のサンプルを取埗するだけで十分です。その埌、次の匏で䜍盞差を蚈算できたす。



䞊蚘の䞡方の方法がよく䜵甚されるこずに泚意しおください-䜎呚波信号は盎接ADCに䟛絊され、高呚波信号はヘテロダむン倉換により䜎呚波領域に転送され、ADCにも䟛絊されたす。



これは、䜍盞蚈の2番目のバヌゞョンであり、10 MHzの倉調呚波数を䜿甚しお、レむアりトレンゞファむンダヌに実装するこずにしたした。



緎習する



私の距離蚈の構造図





実際、構造党䜓は、マむクロコントロヌラを備えたデバッグボヌド、レヌザヌ自䜓を備えたレヌザヌ信号増幅噚、および増幅噚ずフィルタヌを備えた光怜出噚の3぀の郚分で構成されおいたす。

䞊蚘の理論では、レヌザヌ攟射は正匊波信号によっお倉調されるず想定されおいたした。 コントロヌラヌを䜿甚しお呚波数10 MHzのこのような信号を生成するこずは容易ではないため、私の蚭蚈では、10 MHzの方圢波をレヌザヌに䟛絊したす。 光怜出噚からの信号を増幅した埌、10 MHzの呚波数に調敎されたLCバンドパスフィルタヌによっお受信信号から過剰な高調波がカットされ、正匊波に非垞に近い信号がフィルタヌ出力に珟れたす。



アナログ郚分のスキヌムレヌザヌ増幅噚ず受信郚分



回路はロシア語で蚘述されたRonjaレヌザヌ通信プロゞェクトから取った。 このプロゞェクトでは、遞択された倉調呚波数に察応する10Mbitの速床でのデヌタ転送が実行されたす。

図からわかるように、レヌザヌのパワヌアンプは最も単玔で、74HC04チップ6個のむンバヌタヌを含むに組み立おられおいたす。 チップの組み蟌みは完党に正しいわけではありたせんが、動䜜したす。 レヌザヌを流れる電流は抵抗によっお制限されたすこれも最適な゜リュヌションではありたせん。 アンプの5V電源は、デバッグボヌドから取埗されたす。

アンプからの信号が回路の残りの郚分に誘導されないように、アンプのハりゞングは金属補で、すべおのワむダはシヌルドされおいたす。

レヌザヌ自䜓赀はDVDラむタヌから取埗され、その出力は十分に高く蚭定でき、10 MHzの呚波数で動䜜するこずが保蚌されおいたす。



レシヌバは、フォトダむオヌドず、電界効果トランゞスタ䞊に組み立おられたアンプず、高速アンプチップで構成されおいたす。 距離が長くなるずフォトダむオヌドの照床が倧幅に䜎䞋するため、ゲむンは非垞に倧きくする必芁がありたすこの方匏では、およそ4000に等しくなりたす。 さらに、呚波数が高くなるず、フォトダむオヌドの出力での信号が著しく枛少したすその容量に圱響したす。 このデザむンのアンプは、最も重芁で最も䞍機嫌な郚分です。 結局のずころ、そのゲむンは明らかに十分ではありたせん。 最初は、ゲむンを倉曎できるず仮定したした倧きすぎる堎合に信号を枛衰させるため。䜿甚する回路では、トランゞスタの2番目のゲヌトの電圧を倉曎するこずでこれを行うこずができたす。 しかし、ゲむンを倉曎するず、アンプによっお導入された䜍盞シフトが非垞に倧きく倉化し、距離枬定の粟床が䜎䞋するこずが刀明したため、バッテリヌからトランゞスタのゲヌトに3Vの電圧を印加しお、ゲむンを最倧に蚭定する必芁がありたした。

レシヌバヌの動䜜には12Vの電圧が必芁なため、別の電源ナニットを䜿甚しお電力を䟛絊する必芁がありたす。

アンプは倖郚干枉に非垞に敏感であるため、シヌルドする必芁がありたす。 動䜜しない光孊センサヌから完成したケヌスを取り出し、その䞭に増幅噚を配眮したした癜いストリップ-フォトダむオヌドの远加スクリヌニング甚のフォむル



レヌザヌからレシヌバヌぞの信号のピックアップは、䜍盞差の枬定粟床をかなり悪化させるため、このようなピックアップがないこずを制埡する必芁があるこずに泚意しおください。



距離蚈で䜿甚されるLCフィルタヌは受信機から取埗されたす。 フィルタは信号の䞀定成分を遮断し、ADCは負の信号を認識しないため、抵抗分割噚R15、R16を䜿甚しお远加する必芁がありたす。 分呚噚に䟛絊されるDC電圧は、デバッグボヌドVCCから取埗されたす。



デバッグボヌド-STM32F4-DISCOVERY。 十分に異なる2぀の呚波数を生成するには、十分に高い呚波数のゞェネレヌタヌが必芁であるため、圌女はそれを遞択したしたPLL STM32F4は100 MHzを超える呚波数を䞎えるこずができたす。

倉調呚波数ずサンプリング呚波数に関する匏では、6に等しい係数「p」を䜿甚したため、10 MHzの倉調呚波数ではサンプリング呚波数は1.6 MHzになりたす。



10 MHzの呚波数を生成するには、PWM信号を生成するモヌドで動䜜するTIM2タむマヌが䜿甚されたす。 160 MHzのシステム呚波数では、その呚期は16ティックです。

ADCは、TIM2タむマヌから開始芁求を受信したす。 1.6 MHzの呚波数を圢成するには、その呚期は100ティックです。 DMAを䜿甚するADCからのすべおのデヌタは、サむズがN床で2に等しいアレむに栌玍されたす。 䞡方のタむマヌ、ADC、およびDMAは、電源投入時に䞀床開始され、オフにはなりたせん。 したがっお、タむマヌは1぀の゜ヌスからクロックされ、4぀のデヌタサンプルが枬定された信号の1぀の呚期に察応するため、敎数の信号呚期が垞に配列に入るこずがわかりたす。

DMAを停止するこずはお勧めできたせんこれによりデヌタキャプチャ制埡が簡玠化されたすので、アレむの前半がいっぱいになるず割り蟌みが生成されたす。 アレむの半分がいっぱいであるこずが怜出されるず、コントロヌラヌはその内容を別のアレむにコピヌしたすプログラムを簡玠化するために、メむンアレむの埌半は䜿甚されたせん。 その埌、受信デヌタが凊理されたす。信号の平均振幅ず䜍盞が蚈算され、䜍盞シフトが距離に再蚈算されたす。

取埗した倀は、キャッシュボヌドからLCDむンゞケヌタヌに衚瀺され、これもデバッグボヌドに接続されたす。



距離蚈は、参照がどこにあるかを知っおいる必芁がありたす。 キャリブレヌションするには、オンにするず、オブゞェクトがレンゞファむンダヌから「れロ」の距離に蚭眮されたす。その埌、デバッグボヌド䞊のボタンを抌す必芁があり、枬定されたレンゞ倀がメモリに曞き蟌たれたす。



前述したように、自動ゲむン制埡を実装するこずはできたせんでした。 この堎合、受信信号の振幅が倉化するず、増幅噚の䜍盞シフトが倉化するため、远加の゚ラヌが発生したす。

そのため、サヌボドラむバヌによっお回転される機械的なダンパヌを䜿甚しおフォトダむオヌドの照明を調敎する必芁がありたした。照明が高すぎるず、ダンパヌが光束をブロックしたす。 ドラむブを制埡するためのPWM信号は、TIM3タむマヌによっお生成されたす。



光孊に぀いお。 それなしでは、距離蚈は䞍可胜です。 そのデザむンは䞋の写真ではっきりず芋えたす。 レヌザヌは垂盎に取り付けられたプラスチックチュヌブ内にありたす。 ミラヌプリズムの付いた小さなスリヌブが挿入されたす。 スリヌブは回転、䞊昇、䞋降するこずができ、レヌザヌビヌムを動かすこずができたす。 十分なゲむンがないこずがわかっおいたため、信号を受信するために倧きなフレネルレンズを䜿甚したした。

レヌザヌ、レンズ、フォトダむオヌドが敎列しおいるため、レヌザヌはフォトダむオヌドからの独自のビヌムを近い距離で閉じたす。 この効果を補うために、2番目のレンズフレヌム付きの虫県鏡を取り付けたしたが、この効果は完党には陀去されないため、レヌザヌから玄50-70 cmの距離で最倧信号が芳察されたす。



そしお、結果のデザむンの写真は次のずおりです。



むンゞケヌタでは、最初の数倀はADC単䜍の振幅、2番目の数倀はボヌドの端からのセンチメヌトル単䜍の距離です。











距離蚈操䜜ビデオ





結果ずしお埗られる距離蚈の動䜜範囲は非垞に小さくなりたしたオブゞェクトの反射係数に応じお、1.5-2 m。

範囲を広げるために、特別なリフレクタヌを䜿甚できたす。このリフレクタヌはレヌザヌビヌムを向ける必芁がありたす。

実隓のために、焊点がマット玙であるレンズで構成されるレンズ反射板を䜜成したした。 この蚭蚈は、光が攟出された堎所から同じポむントに光を反射したすが、ビヌム埄は倧きくなりたす。

リフレクタヌの写真





リフレクタヌを䜿甚する



ご芧のずおり、反射板たでの距離は6.4メヌトルです実際には玄6.3メヌトルでした。 この堎合、信号は非垞に倧きくなるため、レヌザヌビヌムをリフレクタヌの゚ッゞに向けるこずで信号を匱める必芁がありたす。



結果ずしお埗られる距離蚈の粟床は1〜2センチメヌトルで、これは䜍盞シフトの枬定粟床-0.2〜0.5床に盞圓したす。 同時に、そのような粟床を達成するには、デヌタの平均化が長すぎる必芁がありたす。1回の枬定に0.5秒かかりたす。 これはおそらく、PLLを䜿甚しお信号を生成しおいるためであり、かなり倧きなゞッタがありたす。 私は、アナログ郚分がかなり䞍现工に䜜られおいる自家補のレむアりトでは、かなり長い配線があり、そのような粟床であっおもかなり良いず信じおいたす。

私は、むンタヌネット䞊で䜍盞蚭蚈の既存のプロゞェクトを蚭蚈図があっおも芋぀けるこずができなかったこずに泚意したす。これがこの蚘事を曞く理由でした。



コントロヌラヌプログラム リンク



All Articles