The application discloses a multi-frequency fusion
ranging method and
system based on echo quality
adaptive control, relates to the field of multi-frequency
ranging, and comprises the following steps: high and
low frequency modulated light signals are transmitted to a target and echoes are received,
echo signal characteristics of each frequency are obtained through
demodulation, multi-frame echo quality evaluation quantities are calculated, and a
hysteresis-continuous multi-frame judgment mechanism is adopted to identify that the current
ranging state is normal or weak light. In the
normal state, a
high frequency dominant ranging strategy is executed; in the weak light state, the configuration parameters of the receiving front end are adjusted, and the judgment mechanism is used to adaptively switch to a
low frequency dominant ranging strategy. According to the single frequency distance value of each frequency and the multi-frequency fusion weight corresponding to the selected strategy, the final ranging result is calculated. The application combines the
hysteresis and continuous multi-frame judgment with the
low frequency dominant mode, constructs a state
machine cooperative link under weak light, realizes the stable linkage of the front end parameters, phase
processing and multi-frequency fusion, realizes the smooth switching of the ranging strategy, and improves the ranging stability and accuracy under weak light.