CN103399327A - Beidou system-based satellite signal optimizing system and method - Google Patents
Beidou system-based satellite signal optimizing system and method Download PDFInfo
- Publication number
- CN103399327A CN103399327A CN2013103124529A CN201310312452A CN103399327A CN 103399327 A CN103399327 A CN 103399327A CN 2013103124529 A CN2013103124529 A CN 2013103124529A CN 201310312452 A CN201310312452 A CN 201310312452A CN 103399327 A CN103399327 A CN 103399327A
- Authority
- CN
- China
- Prior art keywords
- satellite signal
- beidou
- obstacle avoidance
- signal
- receiving antenna
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000005457 optimization Methods 0.000 claims abstract description 43
- 238000012544 monitoring process Methods 0.000 claims abstract description 23
- 230000005540 biological transmission Effects 0.000 claims abstract description 10
- 230000033001 locomotion Effects 0.000 claims description 42
- 230000008569 process Effects 0.000 claims description 12
- 238000012806 monitoring device Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000012937 correction Methods 0.000 claims description 4
- 230000002159 abnormal effect Effects 0.000 claims description 3
- SAZUGELZHZOXHB-UHFFFAOYSA-N acecarbromal Chemical compound CCC(Br)(CC)C(=O)NC(=O)NC(C)=O SAZUGELZHZOXHB-UHFFFAOYSA-N 0.000 abstract 1
- 238000004891 communication Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 5
- 238000005070 sampling Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 3
- 239000000919 ceramic Substances 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000007599 discharging Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
Images
Landscapes
- Variable-Direction Aerials And Aerial Arrays (AREA)
Abstract
一种基于北斗系统的卫星信号寻优系统及方法,该系统包括上位机、智能避障小车、无源北斗系统、天线姿态控制系统、供电系统和监控系统;无源北斗系统包括北斗接收天线、射频模块、FPGA和DSP,天线姿态控制系统包括驱动模块、超声波传感器和ARM处理器;供电系统包括太阳能电池组和太阳能电池控制器,监控系统包括监视设备、传输设备和显示设备,本发明的系统及方法具有能源利用效率高、搜寻卫星的信号质量好的特点。采用信号寻优算法对系统运行的状态参数和卫星信号的质量参数进行预测,克服卫星信号不稳定、控制指令执行滞后的缺点,基于雷达激光的可移动式小车与北斗接收天线的结合,能够智能跟踪优质的卫星信号,提高接收的卫星信号的质量。
A satellite signal optimization system and method based on the Beidou system, the system includes a host computer, an intelligent obstacle avoidance car, a passive Beidou system, an antenna attitude control system, a power supply system and a monitoring system; the passive Beidou system includes a Beidou receiving antenna, Radio frequency module, FPGA and DSP, antenna attitude control system comprises drive module, ultrasonic sensor and ARM processor; Power supply system comprises solar battery group and solar battery controller, monitoring system comprises monitoring equipment, transmission equipment and display equipment, system of the present invention The method and the method have the characteristics of high energy utilization efficiency and good signal quality for searching satellites. The signal optimization algorithm is used to predict the state parameters of the system operation and the quality parameters of satellite signals to overcome the shortcomings of unstable satellite signals and lagging control command execution. The combination of the movable car based on radar laser and the Beidou receiving antenna can intelligently Track high-quality satellite signals and improve the quality of received satellite signals.
Description
技术领域technical field
本发明属于电子信息技术领域,具体涉及一种基于北斗系统的卫星信号寻优系统及方法。The invention belongs to the technical field of electronic information, and in particular relates to a satellite signal optimization system and method based on the Beidou system.
背景技术Background technique
卫星导航定位系统对经济发展、社会效益以及军事领域都具有重要的影响,我国非常重视对卫星导航定位系统的建设和发展,一直不断地努力探索和研究。“北斗卫星导航定位系统”(简称“北斗系统”)是由我国白行研发、独立运行的能够覆盖全球的卫星导航定位系统,目前处于组网阶段。该系统已经在测绘、通信、交通运输、公共安全和减灾救灾等很多领域成功应用,带来了显著的经济效益和社会效益。Satellite navigation and positioning systems have an important impact on economic development, social benefits and military fields. Our country attaches great importance to the construction and development of satellite navigation and positioning systems, and has been working hard to explore and research. "Beidou Satellite Navigation and Positioning System" (referred to as "Beidou System") is a satellite navigation and positioning system that can cover the whole world developed by my country's Baixing and operates independently. It is currently in the networking stage. The system has been successfully applied in many fields such as surveying and mapping, communication, transportation, public safety and disaster reduction and relief, bringing significant economic and social benefits.
“北斗系统”作为一种新的卫星导航定位系统,有明显的技术优势,但也有一定的应用缺陷和不足。其中,最为突出的缺陷是“北斗系统”信号的不稳定,经常会出现北斗接收天线在某一时间段或某一方向上搜不到信号,或者搜到的信号质量特别差的情况。稳定的信号是“北斗系统”能够得以良好应用的前提和保障。目前,还没有很好的技术来解决“北斗系统”信号不稳定的问题,该问题是制约“北斗系统”发展的重要因素之一,应该得到高度的重视并予以相应的对策去解决。As a new satellite navigation and positioning system, "Beidou System" has obvious technical advantages, but it also has certain application defects and deficiencies. Among them, the most prominent defect is the instability of the "Beidou system" signal. It often happens that the Beidou receiving antenna cannot find a signal in a certain period of time or in a certain direction, or the quality of the signal found is particularly poor. A stable signal is the prerequisite and guarantee for the good application of the Beidou system. At present, there is no good technology to solve the problem of signal instability of the "Beidou system". This problem is one of the important factors restricting the development of the "Beidou system". It should be highly valued and corresponding countermeasures should be taken to solve it.
发明内容Contents of the invention
针对现有技术存在的问题,本发明提供一种基于北斗系统的卫星信号寻优系统,包括上位机、智能避障小车、无源北斗系统、天线姿态控制系统、供电系统和监控系统;Aiming at the problems existing in the prior art, the present invention provides a satellite signal optimization system based on the Beidou system, including a host computer, an intelligent obstacle avoidance car, a passive Beidou system, an antenna attitude control system, a power supply system and a monitoring system;
智能避障小车包括电机驱动模块、舵机驱动模块、激光雷达模块和运动控制模块,激光雷达模块的输出端连接运动控制模块的输入端,运动控制模块的不同输出端分别连接电机驱动模块的输入端和舵机驱动模块的输入端;The intelligent obstacle avoidance car includes a motor drive module, a steering gear drive module, a laser radar module and a motion control module. The output end of the laser radar module is connected to the input end of the motion control module, and the different output ends of the motion control module are respectively connected to the input of the motor drive module. terminal and the input terminal of the steering gear drive module;
所述无源北斗系统包括北斗接收天线、射频模块、FPGA和DSP,北斗接收天线固定安装在智能避障小车上,北斗接收天线的输出端连接射频模块的输入端,射频模块的输出端连接FPGA的输入端,FPGA的输出端连接DSP的输入端;The passive Beidou system includes a Beidou receiving antenna, a radio frequency module, an FPGA and a DSP, the Beidou receiving antenna is fixedly installed on the intelligent obstacle avoidance car, the output of the Beidou receiving antenna is connected to the input of the radio frequency module, and the output of the radio frequency module is connected to the FPGA The input end of the FPGA, the output end of the FPGA is connected to the input end of the DSP;
所述天线姿态控制系统包括驱动模块、超声波传感器和ARM处理器;DSP的一个输出端连接ARM处理器的输入端,ARM处理器的两个不同输出端分别连接上位机和驱动模块的输入端,驱动模块的输出端连接北斗接收天线的输入端,用于探测北斗接收天线的俯仰角度和方位状态的超声波传感器的输出端连接ARM处理器的输入端;The antenna attitude control system includes a drive module, an ultrasonic sensor and an ARM processor; an output end of the DSP is connected to an input end of the ARM processor, and two different output ends of the ARM processor are respectively connected to an input end of the upper computer and the drive module, The output end of the drive module is connected to the input end of the Beidou receiving antenna, and the output end of the ultrasonic sensor used to detect the pitch angle and azimuth state of the Beidou receiving antenna is connected to the input end of the ARM processor;
所述供电系统包括太阳能电池组和太阳能电池控制器,太阳能电池组中的各太阳能电池并联,太阳能电池控制器与太阳能电池组连接,太阳能电池控制器的输入端与DSP的一个输出端连接;The power supply system includes a solar cell group and a solar cell controller, each solar cell in the solar cell group is connected in parallel, the solar cell controller is connected to the solar cell group, and an input end of the solar cell controller is connected to an output end of the DSP;
所述智能避障小车、无源北斗系统、天线姿态控制系统均由供电系统进行供电,太阳能电池组中各太阳能电池的输出端分别连接智能避障小车、无源北斗系统、天线姿态控制系统;The intelligent obstacle avoidance car, the passive Beidou system, and the antenna attitude control system are all powered by the power supply system, and the output ends of each solar cell in the solar battery pack are respectively connected to the intelligent obstacle avoidance car, the passive Beidou system, and the antenna attitude control system;
所述监控系统包括监视设备、传输设备和显示设备,监视设备安置在智能避障小车运动的环境范围内,监视设备的输出端通过传输设备连接到显示设备。The monitoring system includes a monitoring device, a transmission device and a display device. The monitoring device is placed within the environment range of the movement of the intelligent obstacle avoidance car, and the output end of the monitoring device is connected to the display device through the transmission device.
采用所述的基于北斗系统的卫星信号寻优系统进行卫星信号寻优的方法,包括以下步骤:The method for performing satellite signal optimization using the satellite signal optimization system based on the Beidou system includes the following steps:
步骤1:DSP判断智能避障小车、无源北斗系统、天线姿态控制系统和监控系统的供电是否正常:是,则执行步骤3,否,则执行步骤2;Step 1: DSP judges whether the power supply of the intelligent obstacle avoidance car, passive Beidou system, antenna attitude control system and monitoring system is normal: if yes, go to
步骤2:通过太阳能电池控制器控制太阳能电池对智能避障小车、无源北斗系统、天线姿态控制系统和监控系统进行供电;Step 2: Use the solar battery controller to control the solar battery to supply power to the intelligent obstacle avoidance car, passive Beidou system, antenna attitude control system and monitoring system;
步骤3:智能避障小车运动过程中,通过激光雷达模块实时勘测小车运动环境中的障碍物,实现智能避障小车移动过程中智能避障,同时,监控系统对智能避障小车运动过程实时监控;Step 3: During the movement of the intelligent obstacle avoidance car, the laser radar module is used to detect the obstacles in the moving environment of the car in real time, so as to realize the intelligent obstacle avoidance during the movement of the intelligent obstacle avoidance car. At the same time, the monitoring system monitors the movement process of the intelligent obstacle avoidance car in real time ;
步骤4:北斗接收天线实时接收当前的卫星信号,并将该卫星信号经射频模块发送至FPGA;Step 4: The Beidou receiving antenna receives the current satellite signal in real time, and sends the satellite signal to the FPGA through the RF module;
步骤5:FPGA对卫星信号进行解调解扩,并将解调解扩后的信号传送给DSP;Step 5: The FPGA demodulates and despreads the satellite signal, and transmits the demodulated and despreaded signal to the DSP;
步骤6:DSP对接收到的信号进行定位解算和时间修正,从而完成授时,并将该授时信息传输到ARM处理器进行保存,同时,超声波传感器采集北斗接收天线当前时刻的俯仰角度和方位状态信息并传输至ARM处理器进行保存;Step 6: The DSP performs positioning calculation and time correction on the received signal to complete the timing, and transmits the timing information to the ARM processor for storage. At the same time, the ultrasonic sensor collects the pitch angle and azimuth status of the Beidou receiving antenna at the current moment The information is transmitted to the ARM processor for storage;
所述授时信息包括智能避障小车当前时刻位置信息、当前时间信息和信号强度信息;The timing information includes the current position information, current time information and signal strength information of the intelligent obstacle avoidance car;
步骤7:ARM处理器将保存的授时信息和北斗接收天线当前时刻的俯仰角度和方位状态信息发送至上位机;Step 7: The ARM processor sends the saved timing information and the current pitch angle and azimuth status information of the Beidou receiving antenna to the host computer;
步骤8:ARM处理器采用信号寻优学习算法,对下一时刻的最优卫星信号可能出现的范围进行预测,进而寻找到最优卫星信号;Step 8: The ARM processor uses the signal optimization learning algorithm to predict the possible range of the optimal satellite signal at the next moment, and then find the optimal satellite signal;
具体步骤如下:Specific steps are as follows:
步骤8.1:ARM处理器将接收到的各个时刻的授时信息及其对应的北斗接收天线的俯仰角度和方位状态信息进行归一化处理;Step 8.1: The ARM processor normalizes the received timing information at each moment and the corresponding pitch angle and azimuth status information of the Beidou receiving antenna;
步骤8.2:将归一化处理后的数据作为信号寻优学习的样本数据;Step 8.2: Use the normalized data as sample data for signal optimization learning;
步骤8.3:根据信号寻优学习的样本数据对下一时刻的最优卫星信号可能出现的范围进行预测;Step 8.3: Predict the possible range of the optimal satellite signal at the next moment according to the sample data learned by signal optimization;
步骤8.3.1:设定卫星信号搜索范围、信号拥挤度因子、信号强度阈值、最多搜索次数和停滞参数;Step 8.3.1: Set the satellite signal search range, signal congestion factor, signal strength threshold, maximum number of searches and stagnation parameters;
所述的停滞参数指搜索卫星信号过程中,连续多次超过信号强度阈值的次数;The stagnation parameter refers to the number of times the signal strength threshold has been exceeded for multiple consecutive times during the process of searching for satellite signals;
步骤8.3.2:对信号寻优学习的样本数据进行搜索,若搜索卫星信号过程中,某范围内卫星信号强度连续多次超过信号强度阈值,且该次数达到停滞参数时,则该范围即下一时刻的最优卫星信号可能出现的范围,执行步骤8.4;否则,执行步骤8.3.3;Step 8.3.2: Search the sample data for signal optimization learning. If during the process of searching for satellite signals, the satellite signal strength within a certain range exceeds the signal strength threshold for several times consecutively, and the number of times reaches the stagnation parameter, then the range is down. For the possible range of the optimal satellite signal at a moment, go to step 8.4; otherwise, go to step 8.3.3;
步骤8.3.3:判断当前信号寻优学习的样本数据的搜索次数是否达到最多搜索次数,是,则执行步骤8.3.4,否则继续搜索;Step 8.3.3: Judging whether the number of searches of the sample data of the current signal optimization learning has reached the maximum number of searches, if yes, perform step 8.3.4, otherwise continue to search;
步骤8.3.4:比较卫星信号搜索范围内各卫星信号的信号强度,将最优卫星信号强度传输至DSP,该信号强度信息、对应的卫星的当前时刻位置信息和当前时间信息形成授时信息,分别发送至ARM处理器和上位机,执行步骤8.1;Step 8.3.4: Compare the signal strength of each satellite signal within the satellite signal search range, and transmit the optimal satellite signal strength to the DSP. The signal strength information, the current position information of the corresponding satellite and the current time information form timing information, respectively Send to the ARM processor and host computer, perform step 8.1;
步骤8.4:采用神经网络算法,对下一时刻的最优卫星信号可能出现的范围内的最优卫星信号进行网络学习,得到下一时刻的最优卫星信号强度预测值,即寻找到最优卫星信号;Step 8.4: Use the neural network algorithm to conduct network learning on the optimal satellite signal within the possible range of the optimal satellite signal at the next moment, and obtain the predicted value of the optimal satellite signal strength at the next moment, that is, find the optimal satellite Signal;
步骤9:ARM处理器将寻找到的最优卫星信号的信号强度及该信号强度对应的位置点的位置信息同时发送至天线姿态控制系统中的驱动模块和智能避障小车的运动控制模块;Step 9: The ARM processor sends the signal strength of the found optimal satellite signal and the position information of the position point corresponding to the signal strength to the drive module in the antenna attitude control system and the motion control module of the intelligent obstacle avoidance car;
所述信号强度对应的位置点的位置信息转换成智能避障小车的位置信息和北斗接收天线的俯仰角度和方位状态信息,智能避障小车的位置信息发送至智能避障小车的运动控制模块,北斗接收天线的俯仰角度和方位状态信息发送至天线姿态控制系统中的驱动模块;The position information of the position point corresponding to the signal strength is converted into the position information of the intelligent obstacle avoidance car and the pitch angle and azimuth state information of the Beidou receiving antenna, and the position information of the intelligent obstacle avoidance car is sent to the motion control module of the intelligent obstacle avoidance car, The pitch angle and azimuth state information of the Beidou receiving antenna are sent to the drive module in the antenna attitude control system;
步骤10:智能避障小车的运动控制模块控制智能避障小车在最优卫星信号可能出现的范围内运动;Step 10: The motion control module of the smart obstacle avoidance car controls the movement of the smart obstacle avoidance car within the possible range of the optimal satellite signal;
步骤11:天线姿态控制系统中的驱动模块根据接收到的信息调整北斗接收天线的姿态,使北斗接收天线在最优卫星信号可能出现的范围内的接收方向最佳;Step 11: The drive module in the antenna attitude control system adjusts the attitude of the Beidou receiving antenna according to the received information, so that the receiving direction of the Beidou receiving antenna is the best within the range where the optimal satellite signal may appear;
步骤12:当北斗接收天线接收到卫星信号时,DSP将该卫星信号的授时信息传至ARM处理器进行保存;Step 12: When the Beidou receiving antenna receives the satellite signal, the DSP transmits the timing information of the satellite signal to the ARM processor for storage;
步骤13:ARM处理器向上位机上传当前系统运行的状态参数,该状态参数包括:信号寻优算法预测的下一时刻最优卫星信号可能出现的范围和当前最优卫星信号授时信息;Step 13: The ARM processor uploads the status parameters of the current system operation to the host computer. The status parameters include: the possible range of the optimal satellite signal at the next moment predicted by the signal optimization algorithm and the current optimal satellite signal timing information;
步骤14:操作人员可以根据上位机接收的当前系统运行的状态参数,对卫星信号寻优系统进行实时控制,当系统供电不正常时,可通过上位机向DSP发出控制指令,控制太阳能电池对系统进行供电。Step 14: The operator can control the satellite signal optimization system in real time according to the status parameters of the current system operation received by the host computer. When the system power supply is abnormal, the operator can send a control command to the DSP through the host computer to control the solar battery to the system. power supply.
有益效果:Beneficial effect:
本发明的一种基于北斗的智能信号接收天线系统具有能源利用效率高、搜寻卫星的信号质量好、系统运行稳定的特点。与传统的“北斗系统”信号接收装置相比,由于采用了太阳能电池作为主要电源,使得本系统的能源利用率高于传统系统15%左右。系统采用FPGA、DSP微处理器构成的集成一体化控制系统,对各个模块进行有效控制,采用信号寻优算法对系统运行的状态参数和卫星信号的质量参数进行预测,克服了卫星信号不稳定、控制指令执行滞后的缺点,基于雷达激光的可移动式小车与北斗接收天线的结合,突破了传统的接收天线技术,由被动接收模式转变成主动寻找模式,能够智能跟踪优质的卫星信号,大大提高了接收的卫星信号的质量以及系统运行的稳定性。The Beidou-based intelligent signal receiving antenna system of the present invention has the characteristics of high energy utilization efficiency, good signal quality for searching satellites, and stable system operation. Compared with the traditional "Beidou system" signal receiving device, due to the use of solar cells as the main power source, the energy utilization rate of this system is about 15% higher than that of the traditional system. The system adopts an integrated integrated control system composed of FPGA and DSP microprocessor to effectively control each module, and uses signal optimization algorithm to predict the state parameters of the system operation and the quality parameters of satellite signals, which overcomes the instability of satellite signals, The shortcomings of the lag in the execution of control commands, the combination of the radar laser-based movable car and the Beidou receiving antenna has broken through the traditional receiving antenna technology, changing from passive receiving mode to active searching mode, which can intelligently track high-quality satellite signals, greatly improving The quality of the received satellite signal and the stability of the system operation are guaranteed.
附图说明Description of drawings
图1是本发明具体实施方式的系统总体结构图;Fig. 1 is the overall system structural diagram of the specific embodiment of the present invention;
图2是本发明具体实施方式的舵机驱动模块的控制原理图;Fig. 2 is the control schematic diagram of the steering gear drive module of the specific embodiment of the present invention;
图3是本发明具体实施方式的运动控制模块控制原理图;Fig. 3 is a control schematic diagram of a motion control module according to a specific embodiment of the present invention;
图4是本发明具体实施方式的信号调制电路原理图;Fig. 4 is a schematic diagram of a signal modulation circuit of a specific embodiment of the present invention;
图5是本发明具体实施方式的三角波扰动信号发生电路原理图;Fig. 5 is a schematic diagram of a triangular wave disturbance signal generating circuit of a specific embodiment of the present invention;
图6是本发明具体实施方式的基于北斗系统的卫星信号寻优方法流程图;Fig. 6 is a flow chart of a satellite signal optimization method based on the Beidou system according to a specific embodiment of the present invention;
图7是本发明具体实施方式的信号寻优算法流程图。Fig. 7 is a flowchart of a signal optimization algorithm in a specific embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图对本发明的具体实施方式做详细说明。The specific implementation manners of the present invention will be described in detail below in conjunction with the accompanying drawings.
如图1所示,本实施方式的基于北斗系统的卫星信号寻优系统,包括上位机、智能避障小车、无源北斗系统、天线姿态控制系统、供电系统和监控系统;As shown in Figure 1, the satellite signal optimization system based on the Beidou system in this embodiment includes a host computer, an intelligent obstacle avoidance car, a passive Beidou system, an antenna attitude control system, a power supply system, and a monitoring system;
智能避障小车包括电机驱动模块、舵机驱动模块、激光雷达模块和运动控制模块,激光雷达模块的输出端连接运动控制模块的输入端,运动控制模块的不同输出端分别连接电机驱动模块的输入端和舵机驱动模块的输入端。由激光雷达传感器探测智能避障小车周围的环境,根据探测到的信号,将信号传到运动控制模块中,运动控制模块根据信号来控制电机驱动模块和舵机驱动模块,以实现智能避障小车的前进、后退、转弯的运动,从而顺利绕开障碍物。The intelligent obstacle avoidance car includes a motor drive module, a steering gear drive module, a laser radar module and a motion control module. The output end of the laser radar module is connected to the input end of the motion control module, and the different output ends of the motion control module are respectively connected to the input of the motor drive module. terminal and the input terminal of the steering gear drive module. The environment around the intelligent obstacle avoidance car is detected by the laser radar sensor, and the signal is transmitted to the motion control module according to the detected signal. The motion control module controls the motor drive module and the steering gear drive module according to the signal to realize the intelligent obstacle avoidance car. The forward, backward, and turning movements of the robot can smoothly avoid obstacles.
电机驱动模块采用直流电动机,在各种速度下为智能避障小车运动提供动力。该模块将功率三极管组成H桥型电机驱动电路,并利用PWM波来实现对输出电压的有效值大小和极性进行控制,这种调速方式具有调速特性优良、调整平滑、调速范围广、过载能力大、能承受频繁的负载冲击、能耗小等优点,还可以实现频繁的无级快速启动和反转等优点。The motor drive module uses a DC motor to provide power for the movement of the intelligent obstacle avoidance car at various speeds. This module composes the power triode into an H-bridge motor drive circuit, and uses PWM waves to control the effective value and polarity of the output voltage. This speed regulation method has excellent speed regulation characteristics, smooth adjustment, and wide speed regulation range. , large overload capacity, can withstand frequent load shocks, low energy consumption, etc., and can also achieve frequent stepless quick start and reverse.
舵机驱动模块装在智能避障小车的前轮(转向轮)的连杆上,舵机驱动模块的竖直转动转换为连杆的转动,再带动前轮的左右转向。舵机驱动模块是一种位置伺服的驱动器,其工作原理是:控制信号与舵机位置反馈信号比较,获得直流偏置电压,偏置电压进入信号调制芯片产生一个比较电平,经过PWM控制芯片UC1637后,输出一定占空比的PWM信号,用来驱动IPM电路中IGBT的通断,从而实现电动舵机位置的控制,舵机驱动模块的控制原理如图2所示。The steering gear drive module is installed on the connecting rod of the front wheel (steering wheel) of the smart obstacle avoidance car. The vertical rotation of the steering gear drive module is converted into the rotation of the connecting rod, and then drives the front wheel to turn left and right. The steering gear drive module is a position servo driver. Its working principle is: the control signal is compared with the servo position feedback signal to obtain a DC bias voltage, and the bias voltage enters the signal modulation chip to generate a comparison level, which is passed through the PWM control chip. After the UC1637, it outputs a PWM signal with a certain duty cycle to drive the on-off of the IGBT in the IPM circuit, so as to realize the position control of the electric steering gear. The control principle of the steering gear driving module is shown in Figure 2.
激光雷达模块相当于一个传感器,该模块安装在带有编码器的直流电动机(电机驱动模块)上,激光雷达测距离,编码器测角度,这样直流电动机带动激光雷达模块转动一周便可以构建出周围的环境信息。The laser radar module is equivalent to a sensor. The module is installed on a DC motor (motor drive module) with an encoder. The laser radar measures the distance and the encoder measures the angle. In this way, the DC motor drives the laser radar module to rotate for one revolution to build a surrounding area. environmental information.
运动控制模块采用富士康公司的FM3(FujitsuArm-cortesm3)系列的MCUMB95F506控制器,MCUMB95F506搭载了高精度和高速度的12位的A/D转换器(+/-2LSB1.0μs转换)后,微控制器的高精度采样使马达控制更加精准。控制器的3单元12位A/D的通道多达16路,更能提高位置精度和马达控制的精准性。MCUMB95F506通过不同的I/O引脚分别与电机驱动模块、舵机驱动模块和激光雷达模块进行串口通信,MCUMB95F506通过检测激光雷达模块采集到的信号作出控制决策,从而控制电机和舵机以实现智能避障小车的快速、稳定、正确的运动,MCUMB95F506的控制原理如图3所示,当检测到有障碍物时,由舵机驱动模块控制智能避障小车转弯,否则原速前进,在前进过程中出现行进轨道偏离时,则由电机驱动模块进行减速调整,否则仍按原速前进,直至检测到智能避障小车到达终点,停止运动。The motion control module adopts MCUMB95F506 controller of Foxconn's FM3 (FujitsuArm-cortesm3) series. The high-precision sampling makes the motor control more precise. The 3-unit 12-bit A/D of the controller has as many as 16 channels, which can improve the position accuracy and the precision of motor control. The MCUMB95F506 communicates with the motor drive module, the steering gear drive module and the laser radar module through different I/O pins. For the fast, stable and correct movement of the obstacle avoidance car, the control principle of MCUMB95F506 is shown in Figure 3. When an obstacle is detected, the steering gear drive module controls the intelligent obstacle avoidance car to turn, otherwise it will move forward at the same speed and in the forward process When there is a deviation from the traveling track, the motor drive module will adjust the deceleration, otherwise it will continue to move forward at the original speed until it detects that the intelligent obstacle avoidance car reaches the end point and stops moving.
无源北斗系统包括北斗接收天线、射频模块、FPGA和DSP,北斗接收天线固定安装在智能避障小车上,北斗接收天线的输出端连接射频模块的输入端,射频模块的输出端连接FPGA的输入端,FPGA的输出端连接DSP的输入端;The passive Beidou system includes the Beidou receiving antenna, RF module, FPGA and DSP. The Beidou receiving antenna is fixedly installed on the smart obstacle avoidance car. The output of the Beidou receiving antenna is connected to the input of the RF module, and the output of the RF module is connected to the input of the FPGA. The output end of the FPGA is connected to the input end of the DSP;
无源北斗系统基于“北斗一号”系统,通过无源方式实现定位、授时的功能,北斗接收天线模块采用外置天线,北斗接收天线型号为DY-BDTRT06P00A,该天线为右旋极化陶瓷介质,北斗接收天线模块包括:陶瓷天线、低噪音信号模块、线缆和接头。射频模块采用Aeroflex3030PXI系列的射频模块,该模块可以高精度、高动态范围对射频信号进行变频采样。The passive Beidou system is based on the "Beidou No. 1" system, and achieves positioning and timing functions in a passive manner. The Beidou receiving antenna module uses an external antenna. The Beidou receiving antenna model is DY-BDTRT06P00A. The antenna is a right-handed polarized ceramic medium , The Beidou receiving antenna module includes: ceramic antenna, low-noise signal module, cables and connectors. The radio frequency module adopts the radio frequency module of Aeroflex3030PXI series, which can perform frequency conversion sampling of radio frequency signals with high precision and high dynamic range.
本实施方式的无源北斗系统采用FPGA和DSP进行数据处理,FPGA采用Altera公司的EP2C35F484,它与射频模块通过UART实现异步通信;DSP采用TI公司的TMS320VC5509A。DSP的EMIF信号线全部接到FPGA上,实现二者信息的传递。The passive Beidou system of this embodiment adopts FPGA and DSP for data processing. FPGA adopts EP2C35F484 of Altera Company, which realizes asynchronous communication with the radio frequency module through UART; DSP adopts TMS320VC5509A of TI Company. The EMIF signal lines of the DSP are all connected to the FPGA to realize the transmission of information between the two.
天线姿态控制系统包括驱动模块、超声波传感器和ARM处理器;DSP的输出端连接ARM处理器的输入端,ARM处理器的两个不同输出端分别连接上位机和驱动模块的输入端,驱动模块的输出端连接北斗接收天线的输入端,用于探测北斗接收天线的俯仰角度和方位状态的超声波传感器的输出端连接ARM处理器的输入端。The antenna attitude control system includes a drive module, an ultrasonic sensor and an ARM processor; the output end of the DSP is connected to the input end of the ARM processor, and the two different output ends of the ARM processor are respectively connected to the upper computer and the input end of the drive module. The output end is connected to the input end of the Beidou receiving antenna, and the output end of the ultrasonic sensor used to detect the pitch angle and azimuth state of the Beidou receiving antenna is connected to the input end of the ARM processor.
超声波传感器的型号为SIEMENS 3RG6024-3ACOO,驱动模块采用SGS(通标标准技术服务有限公司)开发的驱动芯片L298N,该模块可以为北斗接收天线的运动提供动力,以实现北斗接收天线360度的自由无障碍转动。The model of the ultrasonic sensor is SIEMENS 3RG6024-3ACOO, and the drive module adopts the drive chip L298N developed by SGS (China Standard Technical Service Co., Ltd.). This module can provide power for the movement of the Beidou receiving antenna to realize the 360-degree freedom of the Beidou receiving antenna Turn without hassle.
ARM处理器包括ARMCortexA9处理器及其外围模块,ARMCortexA9处理器中植入卫星信号寻优算法用来控制北斗接收天线的姿态,以实现北斗接收天线的自动寻优实时跟踪,确保在每时每刻都能将卫星的最优信号反馈给无源北斗系统的DSP并完成授时任务。ARM处理器与DSP通过双口串口进行通信,ARM处理器外围模块包括电压和电流采样转换模块、信号调制电路、三角波扰动信号产生电路、寄存模块和通讯模块,电压和电流采样转换模块包括电压传感器和电流传感器,信号调制电路原理如图4所示,三角波扰动信号发生电路原理如图5所示。寄存模块主要储存系统运行状态参数,选用IS61LV16416型号存储器,存储器电路的41、17、6号引脚连接ARM处理器芯片的42、84、33号引脚。通讯模块采用MAX485芯片,主要负责ARM处理器与上位机之间的通讯,该芯片采用RS485协议建立ARM处理器与上位机之间的通讯协议。上位机通过通信模块MAX485的引脚RO、RE、DI与ARMCortexA9处理器的SCI/RXD、PC2、SCI/TXD引脚相连,MAX485插口通过信号线与上位机串口相连,通过ARM处理器进行集成一体化控制,并带有通讯功能,可实现远程控制。The ARM processor includes the ARM Cortex A9 processor and its peripheral modules. The ARM Cortex A9 processor is embedded with a satellite signal optimization algorithm to control the attitude of the Beidou receiving antenna, so as to realize the automatic optimization and real-time tracking of the Beidou receiving antenna, ensuring that the satellite signal is optimized at every moment. It can feed back the optimal signal of the satellite to the DSP of the passive Beidou system and complete the timing task. The ARM processor communicates with the DSP through a dual-port serial port. The peripheral module of the ARM processor includes a voltage and current sampling conversion module, a signal modulation circuit, a triangular wave disturbance signal generation circuit, a register module and a communication module. The voltage and current sampling conversion module includes a voltage sensor. and the current sensor, the principle of the signal modulation circuit is shown in Figure 4, and the principle of the triangular wave disturbance signal generation circuit is shown in Figure 5. The register module mainly stores the operating state parameters of the system. The IS61LV16416 type memory is selected. Pins 41, 17, and 6 of the memory circuit are connected to pins 42, 84, and 33 of the ARM processor chip. The communication module adopts the MAX485 chip, which is mainly responsible for the communication between the ARM processor and the upper computer. The chip adopts the RS485 protocol to establish the communication protocol between the ARM processor and the upper computer. The upper computer is connected to the SCI/RXD, PC2, SCI/TXD pins of the ARM Cortex A9 processor through the pins RO, RE, and DI of the communication module MAX485, and the MAX485 socket is connected to the serial port of the upper computer through the signal line, and integrated through the ARM processor It has a communication function and can realize remote control.
北斗接收天线实时接收当前的卫星信号传输至FPGA进行信号处理,得到卫星导航电文的解调解扩,并将解调解扩后的信号传送给DSP,DSP进行解调解扩后的信号的收集和处理,实现定位解算以及时间修正值解算,配合FPGA产生精确秒脉冲,在秒脉冲驱动下,计算当前时刻信息,并将该信息传输给ARM处理器;由ARM处理器收到时刻信息,ARM处理器将授时信息和北斗接收天线当前时刻的俯仰角度和方位状态信息发送至上位机,同时对下一时刻的最优卫星信号可能出现的范围进行预测,进而寻找到最优卫星信号,并将最优卫星信号反馈给DSP,完成授时,最终由DSP外围的通讯模块同时向上位机和ARM处理器上传最优卫星信号的授时信息。ARM处理器将信息传递给驱动模块,驱动模块通过对信息的解析做出应答进而控制北斗接收天线的姿态,实现北斗接收天线360度的自由无障碍转动,利用超声波传感器来探测北斗接收天线的俯仰和方位状态,实时地反馈给DSP并由ARM通过串口传送给上位机。The Beidou receiving antenna receives the current satellite signal in real time and transmits it to the FPGA for signal processing to obtain the demodulation and despreading of the satellite navigation message, and transmits the demodulated and despreaded signal to the DSP, and the DSP collects and processes the demodulated and despreaded signal. Realize positioning calculation and time correction value calculation, cooperate with FPGA to generate accurate second pulse, under the drive of second pulse, calculate the current time information, and transmit the information to ARM processor; ARM processor receives the time information, and ARM processes it The timing information and the pitch angle and azimuth status information of the Beidou receiving antenna at the current moment are sent to the host computer, and at the same time, it predicts the possible range of the optimal satellite signal at the next moment, and then finds the optimal satellite signal. The optimal satellite signal is fed back to the DSP to complete the timing, and finally the peripheral communication module of the DSP uploads the timing information of the optimal satellite signal to the upper computer and the ARM processor at the same time. The ARM processor transmits the information to the drive module, and the drive module responds to the analysis of the information to control the attitude of the Beidou receiving antenna, realize the 360-degree free and unobstructed rotation of the Beidou receiving antenna, and use the ultrasonic sensor to detect the pitch of the Beidou receiving antenna and orientation status, real-time feedback to DSP and sent to the host computer by ARM through the serial port.
供电系统包括太阳能电池组和太阳能电池控制器,太阳能电池组中的各太阳能电池并联,太阳能电池控制器与太阳能电池组连接,太阳能电池控制器的输入端与DSP的一个输出端连接;智能避障小车、无源北斗系统、天线姿态控制系统均由供电系统进行供电,太阳能电池组中各太阳能电池的输出端分别连接智能避障小车、无源北斗系统、天线姿态控制系统;The power supply system includes a solar cell group and a solar cell controller, each solar cell in the solar cell group is connected in parallel, the solar cell controller is connected with the solar cell group, and the input end of the solar cell controller is connected with an output end of the DSP; intelligent obstacle avoidance The car, the passive Beidou system, and the antenna attitude control system are all powered by the power supply system, and the output terminals of each solar cell in the solar battery pack are respectively connected to the intelligent obstacle avoidance car, the passive Beidou system, and the antenna attitude control system;
供电系统是将太阳能转化成电能并进行储存,在电能紧缺的时候充当补充电源,太阳能电池控制器对太阳能电池状态进行控制。当太阳能电池供给各系统的电量过高时,通过DSP发出PWM波使得充电开关闭合,太阳能电池充当直流负载,吸收多余的电能并储存;否则,放电开关闭合,太阳能电池继续给各系统供电。The power supply system converts solar energy into electrical energy and stores it, and acts as a supplementary power source when the electrical energy is in short supply. The solar battery controller controls the state of the solar battery. When the power supplied by the solar battery to each system is too high, the PWM wave is sent by the DSP to close the charging switch, and the solar battery acts as a DC load, absorbing excess power and storing it; otherwise, the discharging switch is closed, and the solar battery continues to supply power to each system.
监控系统包括监视设备、传输设备和显示设备,监视设备采用西门子摄像机,该设备安置在智能避障小车运动的环境范围内,监视设备的输出端通过传输设备连接到显示设备。The monitoring system includes monitoring equipment, transmission equipment and display equipment. The monitoring equipment adopts Siemens cameras. The equipment is placed in the environment range of the intelligent obstacle avoidance car. The output of the monitoring equipment is connected to the display equipment through the transmission equipment.
监视设备放置在装载着北斗接收天线的智能避障小车附近,以实现对北斗接收天线、智能避障小车运动的实时监控。传输设备采用光纤,由监视设备输出的视频信号通过光纤传输传给显示设备。显示设备包括硬盘录像系统、视频矩阵、画面处理器、切换器和分配器远程拓展系统,可以实时地观测到北斗接收天线状态及智能避障小车运动的运行情况。The monitoring equipment is placed near the intelligent obstacle avoidance car equipped with the Beidou receiving antenna to realize real-time monitoring of the movement of the Beidou receiving antenna and the intelligent obstacle avoidance car. The transmission device adopts optical fiber, and the video signal output by the monitoring device is transmitted to the display device through optical fiber transmission. The display equipment includes hard disk video recording system, video matrix, picture processor, switcher and distributor remote expansion system, which can observe the status of the Beidou receiving antenna and the operation of the intelligent obstacle avoidance car in real time.
本实施方式是将基于北斗系统的卫星信号寻优系统放置于高楼的楼顶平台上,采用上述的基于北斗系统的卫星信号寻优系统进行卫星信号寻优的方法,如图6所示,包括以下步骤:In this embodiment, the satellite signal optimization system based on the Beidou system is placed on the roof platform of a high-rise building, and the above-mentioned satellite signal optimization system based on the Beidou system is used to perform satellite signal optimization, as shown in Figure 6, including The following steps:
步骤1:DSP判断智能避障小车、无源北斗系统、天线姿态控制系统和监控系统的供电是否正常:是,则执行步骤3,否,则执行步骤2;Step 1: DSP judges whether the power supply of the intelligent obstacle avoidance car, passive Beidou system, antenna attitude control system and monitoring system is normal: if yes, go to
步骤2:通过太阳能电池控制器控制太阳能电池对智能避障小车、无源北斗系统、天线姿态控制系统和监控系统进行供电;Step 2: Use the solar battery controller to control the solar battery to supply power to the intelligent obstacle avoidance car, passive Beidou system, antenna attitude control system and monitoring system;
太阳能电池将太阳能转化成电能并进行储存,在电能紧缺的时候充当补充电源,太阳能电池控制器对太阳能电池状态进行控制。当太阳能电池供给各系统的电量过高时,通过DSP发出PWM波使得充电开关闭合,太阳能电池充当直流负载,吸收多余的电能并储存;否则,放电开关闭合,太阳能电池继续给各系统供电。The solar cell converts solar energy into electric energy and stores it, and acts as a supplementary power source when the electric energy is in short supply, and the solar cell controller controls the state of the solar cell. When the power supplied by the solar battery to each system is too high, the PWM wave is sent out by the DSP to close the charging switch, and the solar battery acts as a DC load to absorb excess power and store it; otherwise, the discharge switch is closed, and the solar battery continues to supply power to each system.
步骤3:智能避障小车运动过程中,通过激光雷达模块实时勘测小车运动环境中的障碍物,实现智能避障小车移动过程中智能避障,同时,监控系统对智能避障小车运动过程实时监控;Step 3: During the movement of the intelligent obstacle avoidance car, the laser radar module is used to detect the obstacles in the moving environment of the car in real time, so as to realize the intelligent obstacle avoidance during the movement of the intelligent obstacle avoidance car. At the same time, the monitoring system monitors the movement process of the intelligent obstacle avoidance car in real time ;
步骤4:北斗接收天线实时接收当前的卫星信号,并将该卫星信号经射频模块发送至FPGA;Step 4: The Beidou receiving antenna receives the current satellite signal in real time, and sends the satellite signal to the FPGA through the RF module;
步骤5:FPGA对卫星信号进行解调解扩,并将解调解扩后的信号传送给DSP;Step 5: The FPGA demodulates and despreads the satellite signal, and transmits the demodulated and despreaded signal to the DSP;
步骤6:DSP对接收到的信号进行定位解算和时间修正,从而完成授时,并将该授时信息传输到ARM处理器进行保存,同时,超声波传感器采集北斗接收天线当前时刻的俯仰角度和方位状态信息并传输至ARM处理器进行保存;Step 6: The DSP performs positioning calculation and time correction on the received signal to complete the timing, and transmits the timing information to the ARM processor for storage. At the same time, the ultrasonic sensor collects the pitch angle and azimuth status of the Beidou receiving antenna at the current moment The information is transmitted to the ARM processor for storage;
授时信息包括智能避障小车当前时刻位置信息、当前时间信息和信号强度信息;The timing information includes the current location information, current time information and signal strength information of the intelligent obstacle avoidance car;
步骤7:ARM处理器将保存的授时信息和北斗接收天线当前时刻的俯仰角度和方位状态信息发送至上位机;Step 7: The ARM processor sends the saved timing information and the current pitch angle and azimuth status information of the Beidou receiving antenna to the host computer;
步骤8:ARM处理器采用信号寻优学习算法,对下一时刻的最优卫星信号可能出现的范围进行预测,进而寻找到最优卫星信号;Step 8: The ARM processor uses the signal optimization learning algorithm to predict the possible range of the optimal satellite signal at the next moment, and then find the optimal satellite signal;
信号寻优学习算法是在现有技术的基本人工鱼群算法改进得到的,如图7所示,ARM处理器采用信号寻优学习算法,对下一时刻的最优卫星信号可能出现的范围进行预测,进而寻找到最优卫星信号的具体步骤如下:The signal optimization learning algorithm is obtained by improving the basic artificial fish swarm algorithm in the prior art. As shown in Figure 7, the ARM processor uses the signal optimization learning algorithm to calculate the possible range of the optimal satellite signal at the next moment. Prediction, and then find the specific steps of the optimal satellite signal as follows:
步骤8.1:ARM处理器将接收到的各个时刻的授时信息及其对应的北斗接收天线的俯仰角度和方位状态信息进行归一化处理;Step 8.1: The ARM processor normalizes the received timing information at each moment and the corresponding pitch angle and azimuth status information of the Beidou receiving antenna;
步骤8.2:将归一化处理后的数据作为信号寻优学习的样本数据;Step 8.2: Use the normalized data as sample data for signal optimization learning;
步骤8.3:根据信号寻优学习的样本数据对下一时刻的最优卫星信号可能出现的范围进行预测;Step 8.3: Predict the possible range of the optimal satellite signal at the next moment according to the sample data learned by signal optimization;
步骤8.3.1:设定卫星信号搜索范围、信号拥挤度因子、信号强度阈值、最多搜索次数和停滞参数;Step 8.3.1: Set the satellite signal search range, signal congestion factor, signal strength threshold, maximum number of searches and stagnation parameters;
所述的停滞参数指搜索卫星信号过程中,连续多次超过信号强度阈值的次数;The stagnation parameter refers to the number of times the signal strength threshold has been exceeded for multiple consecutive times during the process of searching for satellite signals;
步骤8.3.2:对信号寻优学习的样本数据进行搜索,若搜索卫星信号过程中,某范围内卫星信号强度连续多次超过信号强度阈值,且该次数达到停滞参数时,则该范围即下一时刻的最优卫星信号可能出现的范围,执行步骤8.4;否则,执行步骤8.3.3;Step 8.3.2: Search the sample data for signal optimization learning. If during the process of searching for satellite signals, the satellite signal strength within a certain range exceeds the signal strength threshold for several times consecutively, and the number of times reaches the stagnation parameter, then the range is down. For the possible range of the optimal satellite signal at a moment, go to step 8.4; otherwise, go to step 8.3.3;
步骤8.3.3:判断当前信号寻优学习的样本数据的搜索次数是否达到最多搜索次数,是,则执行步骤8.3.4,否则继续搜索;Step 8.3.3: Judging whether the number of searches of the sample data of the current signal optimization learning has reached the maximum number of searches, if yes, perform step 8.3.4, otherwise continue to search;
步骤8.3.4:比较卫星信号搜索范围内各卫星信号的信号强度,将最优卫星信号强度传输至DSP,该信号强度信息、对应的卫星的当前时刻位置信息和当前时间信息形成授时信息,分别发送至ARM处理器和上位机,执行步骤8.1;Step 8.3.4: Compare the signal strength of each satellite signal within the satellite signal search range, and transmit the optimal satellite signal strength to the DSP. The signal strength information, the current position information of the corresponding satellite and the current time information form timing information, respectively Send to the ARM processor and host computer, perform step 8.1;
步骤8.4:对下一时刻的最优卫星信号可能出现的范围内的最优卫星信号进行学习,得到下一时刻的最优卫星信号强度预测值,即寻找到最优卫星信号;Step 8.4: Learn the optimal satellite signal within the possible range of the optimal satellite signal at the next moment, and obtain the predicted value of the optimal satellite signal strength at the next moment, that is, find the optimal satellite signal;
信号寻优算法学习规则是:某卫星信号点的当前状态为Xi,在最优卫星信号可能出现的范围内(即dij≤VISUAL)随机选择一个卫星信号,其状态为Xj,当该随机卫星信号强度大于当前卫星信号强度时,则向该随机卫星信号方向前进一步;反之,则重新随机选择卫星信号,判断是否满足上述前进条件;反复几次后,如果仍不满足前进条件则随机移动一步,学习规则表示如下:The learning rule of the signal optimization algorithm is: the current state of a satellite signal point is X i , and a satellite signal is randomly selected within the possible range of the optimal satellite signal (that is, d ij ≤ VISUAL), and its state is X j , when the When the strength of the random satellite signal is greater than the strength of the current satellite signal, take a step forward in the direction of the random satellite signal; otherwise, randomly select the satellite signal again to determine whether the above advance condition is met; after repeated several times, if the advance condition is still not met, then randomly Moving one step further, the learning rule is expressed as follows:
dij≤VISUAL:d ij ≤ VISUAL:
其中:in:
dij=||Xi-Xj||——相邻两次搜索的卫星信号点之间的距离,即向量(Xi-Xj)的二范数;d ij =||X i -X j ||——the distance between two adjacent searched satellite signal points, that is, the two-norm of the vector (X i -X j );
VISUAL——卫星信号搜索范围,即最优卫星信号可能出现的范围;VISUAL——Satellite signal search range, that is, the range where the optimal satellite signal may appear;
X=(x1,x2,…,xi)——卫星信号各信号点的状态向量,其中,xi为寻优的控制变量;X=(x 1 , x 2 ,..., x i )——the state vector of each signal point of the satellite signal, where x i is the control variable for optimization;
xjk——状态向量Xj的第k个参数;x jk ——the kth parameter of the state vector X j ;
xik——状态向量Xi的第k个参数;x ik ——the kth parameter of the state vector Xi ;
Random(Δ)——[0,Δ]间的随机数;Random(Δ)——a random number between [0, Δ];
Δ——搜索卫星信号时最强与最弱信号的差值;Δ——the difference between the strongest and weakest signals when searching for satellite signals;
FCi——当前接收到的卫星信号强度;FC i - current received satellite signal strength;
FCj——下一次随机搜索的卫星信号强度;FC j ——satellite signal strength for the next random search;
步骤9:ARM处理器将寻找到的最优卫星信号的信号强度及该信号强度对应的位置点的位置信息同时发送至天线姿态控制系统中的驱动模块和智能避障小车的运动控制模块;Step 9: The ARM processor sends the signal strength of the found optimal satellite signal and the position information of the position point corresponding to the signal strength to the drive module in the antenna attitude control system and the motion control module of the intelligent obstacle avoidance car;
所述信号强度对应的位置点的位置信息转换成智能避障小车的位置信息和北斗接收天线的俯仰角度和方位状态信息,智能避障小车的位置信息发送至智能避障小车的运动控制模块,北斗接收天线的俯仰角度和方位状态信息发送至天线姿态控制系统中的驱动模块;The position information of the position point corresponding to the signal strength is converted into the position information of the intelligent obstacle avoidance car and the pitch angle and azimuth state information of the Beidou receiving antenna, and the position information of the intelligent obstacle avoidance car is sent to the motion control module of the intelligent obstacle avoidance car, The pitch angle and azimuth state information of the Beidou receiving antenna are sent to the drive module in the antenna attitude control system;
步骤10:智能避障小车的运动控制模块控制智能避障小车在最优卫星信号可能出现的范围内运动;Step 10: The motion control module of the smart obstacle avoidance car controls the movement of the smart obstacle avoidance car within the possible range of the optimal satellite signal;
步骤11:天线姿态控制系统中的驱动模块根据接收到的信息调整北斗接收天线的姿态,使北斗接收天线在最优卫星信号可能出现的范围内的接收方向最佳;Step 11: The drive module in the antenna attitude control system adjusts the attitude of the Beidou receiving antenna according to the received information, so that the receiving direction of the Beidou receiving antenna is the best within the range where the optimal satellite signal may appear;
步骤12:当北斗接收天线接收到卫星信号时,DSP将该卫星信号的授时信息传至ARM处理器进行保存;Step 12: When the Beidou receiving antenna receives the satellite signal, the DSP transmits the timing information of the satellite signal to the ARM processor for storage;
步骤13:ARM处理器向上位机上传当前系统运行的状态参数,该状态参数包括:信号寻优算法预测的下一时刻最优卫星信号可能出现的范围和当前最优卫星信号授时信息;Step 13: The ARM processor uploads the status parameters of the current system operation to the host computer. The status parameters include: the possible range of the optimal satellite signal at the next moment predicted by the signal optimization algorithm and the current optimal satellite signal timing information;
步骤14:操作人员可以根据上位机接收的当前系统运行的状态参数,对卫星信号寻优系统进行实时控制,当系统供电不正常时,可通过上位机向DSP发出控制指令,控制太阳能电池对系统进行供电。Step 14: The operator can control the satellite signal optimization system in real time according to the status parameters of the current system operation received by the host computer. When the system power supply is abnormal, the operator can send a control command to the DSP through the host computer to control the solar battery to the system. power supply.
Claims (2)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310312452.9A CN103399327B (en) | 2013-07-23 | 2013-07-23 | Beidou system-based satellite signal optimizing system and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310312452.9A CN103399327B (en) | 2013-07-23 | 2013-07-23 | Beidou system-based satellite signal optimizing system and method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103399327A true CN103399327A (en) | 2013-11-20 |
CN103399327B CN103399327B (en) | 2015-04-15 |
Family
ID=49562983
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310312452.9A Expired - Fee Related CN103399327B (en) | 2013-07-23 | 2013-07-23 | Beidou system-based satellite signal optimizing system and method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103399327B (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105929858A (en) * | 2016-06-20 | 2016-09-07 | 烟台民望机电技术有限公司 | Automatic tracking signal electronic device |
CN106443743A (en) * | 2016-11-22 | 2017-02-22 | 丹阳伦图电子技术有限公司 | Beidou positioning device for cableway car broadcasting, and implementation method thereof |
CN106788518A (en) * | 2017-01-19 | 2017-05-31 | 青岛国数信息科技有限公司 | It is a kind of can be across the Beidou communication terminal of intercontinental application |
CN111130618A (en) * | 2019-12-11 | 2020-05-08 | 山东省科学院海洋仪器仪表研究所 | Beidou signal enhancement device and enhancement method |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007249632A (en) * | 2006-03-16 | 2007-09-27 | Fujitsu Ltd | A mobile robot that moves autonomously in an environment with obstacles and a method for controlling the mobile robot |
US20100231448A1 (en) * | 2009-03-13 | 2010-09-16 | Andrew Llc | Method and system for selecting optimal satellites in view |
CN201859352U (en) * | 2010-11-02 | 2011-06-08 | 长安大学 | Obstacle avoiding control device of model car |
CN102385388A (en) * | 2011-10-06 | 2012-03-21 | 张涵 | Solar trolley capable of automatically avoiding obstacles |
CN102621564A (en) * | 2012-03-20 | 2012-08-01 | 东南大学 | Navigation resolving method for GPS (global positioning system) receiver based on DSP (digital signal processor) and system of navigation resolving method |
JP2012194866A (en) * | 2011-03-17 | 2012-10-11 | Kyushu Institute Of Technology | Moving operation determining device, method thereof, and program |
CN202649472U (en) * | 2012-06-29 | 2013-01-02 | 赵小川 | Novel navigation and location system suitable for robot |
CN202661876U (en) * | 2012-04-25 | 2013-01-09 | 广东技术师范学院天河学院 | Intelligent dolly |
-
2013
- 2013-07-23 CN CN201310312452.9A patent/CN103399327B/en not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007249632A (en) * | 2006-03-16 | 2007-09-27 | Fujitsu Ltd | A mobile robot that moves autonomously in an environment with obstacles and a method for controlling the mobile robot |
US20100231448A1 (en) * | 2009-03-13 | 2010-09-16 | Andrew Llc | Method and system for selecting optimal satellites in view |
CN201859352U (en) * | 2010-11-02 | 2011-06-08 | 长安大学 | Obstacle avoiding control device of model car |
JP2012194866A (en) * | 2011-03-17 | 2012-10-11 | Kyushu Institute Of Technology | Moving operation determining device, method thereof, and program |
CN102385388A (en) * | 2011-10-06 | 2012-03-21 | 张涵 | Solar trolley capable of automatically avoiding obstacles |
CN102621564A (en) * | 2012-03-20 | 2012-08-01 | 东南大学 | Navigation resolving method for GPS (global positioning system) receiver based on DSP (digital signal processor) and system of navigation resolving method |
CN202661876U (en) * | 2012-04-25 | 2013-01-09 | 广东技术师范学院天河学院 | Intelligent dolly |
CN202649472U (en) * | 2012-06-29 | 2013-01-02 | 赵小川 | Novel navigation and location system suitable for robot |
Non-Patent Citations (1)
Title |
---|
常健等: "移动机器人避障方法综述", 《仪器仪表学报》, vol. 31, no. 8, 31 August 2010 (2010-08-31), pages 439 - 442 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105929858A (en) * | 2016-06-20 | 2016-09-07 | 烟台民望机电技术有限公司 | Automatic tracking signal electronic device |
CN106443743A (en) * | 2016-11-22 | 2017-02-22 | 丹阳伦图电子技术有限公司 | Beidou positioning device for cableway car broadcasting, and implementation method thereof |
CN106788518A (en) * | 2017-01-19 | 2017-05-31 | 青岛国数信息科技有限公司 | It is a kind of can be across the Beidou communication terminal of intercontinental application |
CN106788518B (en) * | 2017-01-19 | 2018-02-16 | 青岛国数信息科技有限公司 | It is a kind of can be across the Beidou communication terminal of intercontinental application |
CN111130618A (en) * | 2019-12-11 | 2020-05-08 | 山东省科学院海洋仪器仪表研究所 | Beidou signal enhancement device and enhancement method |
Also Published As
Publication number | Publication date |
---|---|
CN103399327B (en) | 2015-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN207817528U (en) | A kind of autonomous cruise makes a return voyage formula unmanned boat | |
CN103399327B (en) | Beidou system-based satellite signal optimizing system and method | |
CN103944202A (en) | Outdoor mobile robot photovoltaic automatic charging method | |
CN110696647A (en) | Automatic charging device and method for power inspection unmanned aerial vehicle | |
CN106313067B (en) | underwater robot communication docking system, underwater robot and cluster control system | |
CN106314731B (en) | Undersea detection fishing robot and method of work, control system | |
CN102442332B (en) | Processing method of intelligent tracking system for solar railway labels | |
CN108072546A (en) | A kind of hybrid power unmanned water acquisition vessel | |
CN103324205B (en) | A kind of mobile robot's solar electrical energy generation tracking system | |
CN106314729A (en) | Underwater joint search and rescue robot and system and working method thereof | |
CN109842198B (en) | An online monitoring system for track plate parameters | |
CN113852338A (en) | Mobile power supply system with inverter alternating current output | |
CN101694382B (en) | Solar azimuth sensor and solar tracking device based on Y-type layout of photovoltaic cells | |
CN111113443B (en) | An intelligent escort robot with multiple energy supply methods | |
CN112985389A (en) | Laser charging tracking method based on unmanned aerial vehicle motion state | |
CN101852853B (en) | Wireless network ranging system based on solar power supply | |
US20230315103A1 (en) | Perception and control system of autonomous snowfield-roaming robot and operation and path planning method thereof | |
CN116961523B (en) | Marine wave light storage power generation device and system with intelligent power system | |
CN203310436U (en) | Grain system information real-time acquisition apparatus | |
CN102566600B (en) | The automatic correction system of motion tracking solar photovoltaic generating system and its implementation | |
CN106272469A (en) | Investigation positioning robot and method of work, control system under water | |
CN204929099U (en) | Intelligent low -power consumption monitored control system | |
CN210852093U (en) | Automatic charging device of electric power inspection unmanned aerial vehicle | |
CN104539223A (en) | Domestic solar and wind energy power supply system | |
CN212137934U (en) | Multi-unmanned ship cooperative control system based on 5G network |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150415 Termination date: 20150723 |
|
EXPY | Termination of patent right or utility model |