一種高精度、寬量程的測距方法及系統與流程
本發明涉及一種高精度、寬量程的測距方法及系統，屬于測距技術領域。
背景技術：
目前市面上常用的測距產品包括3d攝像頭(tof)等使用的測距方法主要有直接脈沖測距法、隨機脈沖相關測距法、相位測距法等。
其中，直接脈沖測距法的測距原理是通過測量脈沖從發射端發出，經過被測目標返回至探測器之間的飛行時間，來計算距離信息，該方法一般用于遠程測距，不適合近距離測距，且精度較低。
隨機脈沖相關測距法的測距原理是通過計算發出的隨機脈沖信號與返回的隨機脈沖信號的互相關函數，來計算距離信息，該方法抗干擾能力強，一般適用于遠程測距，其測距精度受隨機信號的調制頻率限制，精度較低。
相位測距法的測距原理是通過檢測周期信號從發射端發出，經過被測目標返回至探測器之間的相位位移，來計算距離信息，該方法測量精度高，但由于是周期信號，其最大測量距離受最大相位位移2π的限制，后來提出的多頻相位測距法使用2個或多個頻率的周期信號來擴展測距量程，但依然受周期信號的周期限制，因此相位測距法一般用于短距離、高精度的測量場合。
技術實現要素：
本發明所要解決的技術問題是克服現有技術的缺陷，提供一種高精度、寬量程的測距方法及系統。本發明能夠同時兼顧高精度和寬量程，既可以應用在近距離測距，也可以應用在遠距離測距，另外還可以應用于場景深度測量與3d成像、機器人視覺、手勢識別等應用中。
為解決上述技術問題，本發明提供一種高精度、寬量程的測距方法，其特征在于，所述測距方法通過將一種粗精度測距方法與相位測距方法相結合，利用粗精度測距方法調制光源獲得粗精度距離值，利用相位測距方法調制光源獲得一個相位周期內的高精度距離值，然后根據所述粗精度距離值和所述高精度距離值得出測距目標的距離位于相位測距的第幾個相位周期，最后計算出高精度的實際距離值。
作為一種較佳的實施例，具體包括如下步驟：
步驟ss1：配置相關參數，包括相位測距方法的周期信號頻率fp、粗精度測距方法的測距精度rr，轉入步驟ss2；
步驟ss2：根據相位測距方法和粗精度測距方法，同時發出相位測距方法的周期信號與粗精度測距方法的測距信號，轉入步驟ss3；
步驟ss3：將步驟ss2中的周期信號和測距信號疊加成混合信號，并用疊加后的混合信號驅動光源對測距目標發射出混合光信號，轉入步驟ss4；
步驟ss4：探測器接收到返回的步驟ss3中的混合光信號，將混合光信號轉化為混合電信號，然后分別轉入步驟ss5和步驟ss6；
步驟ss5：將步驟ss4中的混合電信號中的周期信號分離出來，進行相位測距計算，根據相位差求出一個相位周期內的高精度距離值lp，轉入步驟ss7；
步驟ss6：將步驟ss4中的混合電信號中的測距信號分離出來，根據粗精度測距方法求出粗精度距離值lr，轉入步驟ss7；
步驟ss7：根據步驟ss6中的粗精度距離值lr和步驟ss5中的高精度距離值lp計算出當前測距目標的距離處于相位測距的第幾個相位周期，然后計算出高精度的實際距離。
作為一種較佳的實施例，步驟ss7具體包括：相位測距方法的周期信號頻率為fp，根據該頻率信號的相位測距的最大距離即一個相位周期tp為：
相位測距方法的相位周期為tp，粗精度測距方法的測距精度為rr，為保證能夠準確的定位測距目標的距離位于相位測距的第幾個相位周期，調整相位測距方法的相位周期為tp和粗精度測距方法的測距精度rr以滿足：
也就是說，粗精度測距方法的精度要小于相位測距方法的相位周期的一半。
作為一種較佳的實施例，所述光源可以是激光光源，但不限于激光光源，也可以是其他可調制的光源。
作為一種較佳的實施例，所述粗精度測距方法可以采用直接脈沖測距方法或者隨即調制測距方法，但不限于這兩種方法，也可以是其他寬量程的測距方法。
作為一種較佳的實施例，所述的粗精度測距方法得出粗精度距離值lr，所述的相位測距方法得出一個相位周期內的高精度距離值lp，若當前測距目標的距離處于相位測距的第n+1個相位周期，那么可以求出n為：
然后，可以求出高精度的實際距離l為：
l＝n·tp+lp
其中，相位測距方法的相位周期為tp，粗精度測距方法的測距精度為rr，的粗精度測距方法得出粗精度距離值lr，的相位測距方法得出一個相位周期內的高精度距離值lp。
本發明還提出一種高精度、寬量程的測距系統，其特征在于，包括中央控制器、周期信號發射模塊、粗精度測距發射模塊、混合信號發射模塊、可調制光源、探測器、帶通濾波器、adc1、adc2、粗精度測距接收模塊、周期信號接收模塊、實際距離計算模塊，中央控制器分別與周期信號發射模塊、粗精度測距發射模塊、混合信號發射模塊、帶通濾波器、adc1、adc2、粗精度測距接收模塊、周期信號接收模塊、實際距離計算模塊相連接，周期信號發射模塊的輸出端、粗精度測距發射模塊的輸出端分別與混合信號發射模塊的輸入端相連接，混合信號發射模塊的輸出端與可調制光源的輸入端相連接，可調制光源的輸出端與探測器的輸入端相連接，探測器的輸出端分別與帶通濾波器的輸入端、adc1的輸入端相連接；帶通濾波器的輸出端與adc2的輸入端相連接，adc2的輸出端與周期信號接收模塊的輸入端相連接，周期信號接收模塊的輸出端與實際距離計算模塊的輸入端相連接；adc1的輸出端與粗精度測距接收模塊的輸入端相連接，粗精度測距接收模塊的輸出端與實際距離計算模塊12的輸入端相連接。
作為一種較佳的實施例，中央控制器1配置相位測距方法的周期信號頻率fp、粗精度測距方法的測距精度rr、帶通濾波器的帶寬、adc1與adc2的采樣頻率；周期信號發射模塊與粗精度測距發射模塊分別發出相位測距方法的周期信號與粗精度測距方法的測距信號輸送給混合信號發射模塊；混合信號發射模塊將周期信號和測距信號疊加，并將疊加后的混合光信號驅動可調制光源對測距目標發射出光線；探測器接收到返回的混合光信號，并將混合光信號轉化為混合電信號，分兩路分別輸出給帶通濾波器和adc1；帶通濾波器過濾掉混合電信號中的其他頻率信號，只允許周期信號對應頻率的信號通過，并輸出給adc2；adc2將周期信號對應頻率的電信號轉化為數字信號后，輸出給周期信號接收模塊；周期信號接收模塊提取出周期信號，根據相位差求出一個相位周期內的高精度距離值；adc1將混合電信號轉化為數字信號后，輸出給粗精度測距接收模塊，粗精度測距接收模塊根據其測距原理，求出粗精度的距離值；實際距離計算模塊根據粗精度距離值和高精度距離值計算出當前所測的距離處于相位測距的第幾個相位周期，并計算出高精度的實際距離。
作為一種較佳的實施例，相位測距方法的周期信號頻率為fp，根據該頻率信號的相位測距的最大距離即一個相位周期tp為：
為保證能夠準確的定位測距目標的距離位于相位測距的第幾個相位周期，需要調整相位測距方法的相位周期tp和粗精度測距方法的測距精度rr以滿足：
也就是說，粗精度測距方法的測距精度小于相位測距方法的相位周期的一半。
作為一種較佳的實施例，的實際距離計算模塊分別得到由粗精度測距接收模塊計算出的粗精度距離值lr與由周期信號接收模塊計算出的高精度距離值lp，若當前測距目標的距離處于相位測距的第n+1個相位周期，那么可以求出n為：
然后，可以求出高精度的實際距離l為：
l＝n·tp+lp
作為一種較佳的實施例，所述光源可以是激光光源，但不限于激光光源，也可以是其他可調制的光源。
作為一種較佳的實施例，所述粗精度測距方法可以采用直接脈沖測距方法或者隨即調制測距方法，但不限于這兩種方法，也可以是其他寬量程的測距方法。
本發明所達到的有益效果：本發明能夠同時兼顧高精度和寬量程，既可以應用在近距離測距，也可以應用在遠距離測距；本發明還可以應用于場景深度測量與3d成像、機器人視覺、手勢識別等應用中；本發明能夠準確的定位測距目標的距離位于相位測距的第幾個相位周期，從而獲得高精度的實際距離。
附圖說明
圖1是當
圖2是當
圖3是當
圖4是本發明的一種高精度、寬量程的測距系統的一個實施例的結構框圖。
圖中標記的含義：1-中央控制器，2-周期信號發射模塊，3-粗精度測距發射模塊，4-混合信號發射模塊，5-1-激光光源，6-1-激光探測器，7-帶通濾波器，8-adc1，9-adc2，10-粗精度測距接收模塊，11-周期信號接收模塊，12-實際距離計算模塊。
圖5是本發明的一種高精度、寬量程的測距系統的另一個實施例的結構框圖。
圖中標記的含義：1-中央控制器，2-周期信號發射模塊，3-粗精度測距發射模塊，4-混合信號發射模塊，5-2-led光源，6-2-led探測器，7-帶通濾波器，8-adc1，9-adc2，10-粗精度測距接收模塊，11-周期信號接收模塊，12-實際距離計算模塊。
具體實施方式
下面結合附圖對本發明作進一步描述。以下實施例僅用于更加清楚地說明本發明的技術方案，而不能以此來限制本發明的保護范圍。
本發明提供一種高精度、寬量程的測距方法，其特征在于，測距方法通過將一種粗精度測距方法與相位測距方法相結合，利用粗精度測距方法調制光源獲得粗精度距離值，利用相位測距方法調制光源獲得一個相位周期內的高精度距離值，然后根據粗精度距離值和高精度距離值得出測距目標的距離位于相位測距的第幾個相位周期，最后計算出高精度的實際距離值。
作為一種較佳的實施例，具體包括如下步驟：
步驟ss1：配置相關參數，包括相位測距方法的周期信號頻率fp、粗精度測距方法的測距精度rr，轉入步驟ss2；
步驟ss2：根據相位測距方法和粗精度測距方法，同時發出相位測距方法的周期信號與粗精度測距方法的測距信號，轉入步驟ss3；
步驟ss3：將步驟ss2中的周期信號和測距信號疊加成混合信號，并用疊加后的混合信號驅動光源對測距目標發射出混合光信號，轉入步驟ss4；
步驟ss4：探測器接收到返回的步驟ss3中的混合光信號，將混合光信號轉化為混合電信號，然后分別轉入步驟ss5和步驟ss6；
步驟ss5：將步驟ss4中的混合電信號中的周期信號分離出來，進行相位測距計算，根據相位差求出一個相位周期內的高精度距離值lp，轉入步驟ss7；
步驟ss6：將步驟ss4中的混合電信號中的測距信號分離出來，根據粗精度測距方法求出粗精度距離值lr，轉入步驟ss7；
步驟ss7：根據步驟ss6中的粗精度距離值lr和步驟ss5中的高精度距離值lp計算出當前測距目標的距離處于相位測距的第幾個相位周期，然后計算出高精度的實際距離。
作為一種較佳的實施例，所述光源可以是激光光源，但不限于激光光源，也可以是其他可調制的光源。
作為一種較佳的實施例，所述粗精度測距方法可以采用直接脈沖測距方法或者隨即調制測距方法，但不限于這兩種方法，也可以是其他寬量程的測距方法。
作為一種較佳的實施例，步驟ss7具體包括：相位測距方法的周期信號頻率為fp，根據該頻率信號的相位測距的最大距離即一個相位周期tp為：
相位測距方法的相位周期為tp，粗精度測距方法的測距精度為rr，為保證能夠準確的定位測距目標的距離位于相位測距的第幾個相位周期，調整相位測距方法的相位周期為tp和粗精度測距方法的測距精度rr以滿足：
也就是說，粗精度測距方法的精度要小于相位測距方法的相位周期的一半。
作為一種較佳的實施例，粗精度測距方法得出粗精度距離值lr，相位測距方法得出一個相位周期內的高精度距離值lp，若當前測距目標的距離處于相位測距的第n+1個相位周期，那么可以求出n為：
然后，可以求出高精度的實際距離l為：
l＝n·tp+lp
其中，相位測距方法的相位周期為tp，粗精度測距方法的測距精度為rr，的粗精度測距方法得出粗精度距離值lr，的相位測距方法得出一個相位周期內的高精度距離值lp。
作為一種較佳的實施例，所述光源可以是激光光源，但不限于激光光源，也可以是其他可調制的光源。
作為一種較佳的實施例，粗精度測距方法采用直接脈沖測距方法或者隨機調制測距方法，但不限于這兩種方法，也可以是其他寬量程的測距方法。
圖4和圖5是本發明的一種高精度、寬量程的測距系統的兩個實施例的結構框圖。本發明還提出一種高精度、寬量程的測距系統，其特征在于，包括中央控制器1、周期信號發射模塊2、粗精度測距發射模塊3、混合信號發射模塊4、可調制光源、探測器、帶通濾波器7、adc18、adc29、粗精度測距接收模塊10、周期信號接收模塊11、實際距離計算模塊12，中央控制器1分別與周期信號發射模塊2、粗精度測距發射模塊3、混合信號發射模塊4、帶通濾波器7、adc18、adc29、粗精度測距接收模塊10、周期信號接收模塊11、實際距離計算模塊12相連接，周期信號發射模塊2的輸出端、粗精度測距發射模塊3的輸出端分別與混合信號發射模塊4的輸入端相連接，混合信號發射模塊4的輸出端與可調制光源的輸入端相連接，可調制光源的輸出端與探測器的輸入端相連接，探測器的輸出端分別與帶通濾波器7的輸入端、adc18的輸入端相連接；帶通濾波器7的輸出端與adc29的輸入端相連接，adc29的輸出端與周期信號接收模塊11的輸入端相連接，周期信號接收模塊11的輸出端與實際距離計算模塊12的輸入端相連接；adc18的輸出端與粗精度測距接收模塊10的輸入端相連接，粗精度測距接收模塊10的輸出端與實際距離計算模塊12的輸入端相連接。
作為一種較佳的實施例，中央控制器1配置相位測距方法的周期信號頻率fp、粗精度測距方法的測距精度rr、帶通濾波器7的帶寬、adc18與adc29的采樣頻率；周期信號發射模塊2與粗精度測距發射模塊3分別發出相位測距方法的周期信號與粗精度測距方法的測距信號輸送給混合信號發射模塊4；混合信號發射模塊4將周期信號和測距信號疊加，并將疊加后的混合光信號驅動可調制光源對測距目標發射出光線；探測器接收到返回的混合光信號，并將混合光信號轉化為混合電信號，分兩路分別輸出給帶通濾波器7和adc18；帶通濾波器7過濾掉混合電信號中的其他頻率信號，只允許周期信號對應頻率的信號通過，并輸出給adc29；adc29將周期信號對應頻率的電信號轉化為數字信號后，輸出給周期信號接收模塊11；周期信號接收模塊11提取出周期信號，根據相位差求出一個相位周期內的高精度距離值；adc18將混合電信號轉化為數字信號后，輸出給粗精度測距接收模塊10，粗精度測距接收模塊10根據其測距原理，求出粗精度距離值；實際距離計算模塊12根據粗精度距離值和高精度距離值計算出當前所測的距離處于相位測距的第幾個相位周期，并計算出高精度的實際距離。
作為一種較佳的實施例，所述相位測距方法的周期信號頻率為fp，根據該頻率信號的相位測距的最大距離即一個相位周期tp為：
所述的粗精度測距方法的測距精度為rr，所述的粗精度測距方法得出粗精度距離值為lr，所述的相位測距方法得出一個相位周期內的高精度距離值為lp，那么根據粗精度測距方法可以知道測距目標距離的范圍在lr-rr到lr+rr之間，令:
lmin＝lr-rr
lmax＝lr-rr
當
當
當
為保證能夠準確的定位測距目標的距離位于相位測距的第幾個相位周期，需要調整所述相位測距方法的相位周期tp和粗精度測距方法的測距精度rr以滿足：
也就是說，所述粗精度測距方法的測距精度小于所述相位測距方法的相位周期的一半。
作為一種較佳的實施例，的實際距離計算模塊12分別得到由粗精度測距接收模塊10計算出的粗精度距離值lr與由周期信號接收模塊11計算出的高精度距離值lp，若當前測距目標的距離處于相位測距的第n+1個相位周期，那么可以求出n為：
然后，可以求出高精度的實際距離l為：
l＝n·tp+lp
作為一種較佳的實施例，所述粗精度測距方法可以采用直接脈沖測距方法或者隨即調制測距方法，但不限于這兩種方法，也可以是其他寬量程的測距方法。
作為一種較佳的實施例，可調制光源為激光光源5-1或者led光源5-2，探測器為激光探測器6-1或者led探測器6-2。
以上所述僅是本發明的優選實施方式，應當指出，對于本技術領域的普通技術人員來說，在不脫離本發明技術原理的前提下，還可以做出若干改進和變形，這些改進和變形也應視為本發明的保護范圍。
- 還沒有人留言評論。精彩留言會獲得點贊！