AOA-based azimuth-following laser wireless energy transmission system and method

Through the AOA and TOF algorithm combined with filtering technology, the azimuth follow-up laser wireless energy transmission system solves the problem of charging efficiency decline caused by short power supply distance and angle changes in traditional wireless charging technology, and realizes long distance and multiple in complex environments The target device is charged, which improves the flexibility and accuracy of charging.

CN118801586BActive Publication Date: 2024-11-15福建省新华都工程有限责任公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411288040.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-14
Publication Date
2024-11-15
Estimated Expiration
2044-09-14

AI Technical Summary

Technical Problem

The existing wireless charging technology has short power supply distance and the charging efficiency decreases when the angle changes. The traditional wireless charging method has high requirements for effective overlapping areas and cannot meet the charging needs of long-distance and multi-target devices in complex environments.

Method used

Adopting an azimuth following laser wireless energy transmission system based on AOA algorithm and TOF algorithm, the laser distance measurement module and servo gimbal realize accurate alignment and follow-up of the laser beam, combined with filtering algorithm and ultra-wideband wireless communication technology, overcome distance limitations and the charging method are limited to achieving long-distance charging of the target device in a mobile state.

Benefits of technology

It realizes the stable transmission efficiency of laser wireless charging within a wide angle range, supports time-sharing power supply for multi-target devices, meets application needs in complex environments, and improves charging flexibility and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118801586B_ABST
    Figure CN118801586B_ABST
Patent Text Reader

Abstract

The present application provides an azimuth-following laser wireless energy transmission system and method based on AOA, the system includes a laser transmitting end and at least one laser receiving end, the laser transmitting end includes a laser source, a control unit, a base station, a steering gear pan / tilt, and a laser ranging module; the laser receiving end includes a photovoltaic cell and a tag, the tag is used to transmit a position signal of the laser receiving end; the base station can receive a position signal of a tag, the control unit obtains an arrival angle, a first distance and a signal strength based on the position signal analysis, and calculates the azimuth and the following angle, and outputs a PWM signal to drive the steering gear pan / tilt to rotate in real time, so that the laser beam of the laser source is aimed at the target device; the laser ranging module can measure the second distance between the laser transmitting end and the target device; when the distance difference between the first distance and the second distance is less than or equal to a preset threshold value, the laser beam of the laser source is irradiated to the surface of the photovoltaic cell, so that the laser receiving end can receive light energy and start charging.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of wireless power transmission, and in particular to an azimuth-following laser wireless power transmission system and method based on AOA. Background Art

[0002] With the rapid development of intelligent technology, position following technology has become a hot research topic in the fields of drones, autonomous vehicles, intelligent robots, etc. Position following not only involves precise positioning and real-time mobile tracking, but also includes the prediction and response to the dynamic behavior of the target. The advancement of these technologies has greatly promoted the application of intelligent devices in autonomous navigation, human-computer interaction and automated services. In this context, how to use following technology to achieve a wider range of applications has become a problem worth exploring.

[0003] Traditional wired power transmission methods can be seen everywhere, from high-voltage power transmission in the national power grid to powering table lamps in homes. Although this method is stable and reliable, with the surge in the number of electrical devices, subsequent home appliances purchased often need to be placed in fixed locations or powered by additional power cords due to the number of power sockets in the house. The use of a large number of wires not only increases safety risks, but also requires additional manpower and material resources for daily safety maintenance. Therefore, the traditional cable power supply method is gradually unable to meet the requirements of harsh working environments, and wireless power transfer (WPT) technology has emerged.

[0004] Compared with traditional cable power transmission, WPT technology does not require any electrical or physical connection, but transmits electrical energy from the power source to the electrical load by using non-contact methods such as radiation fields. To achieve efficient laser wireless energy transmission, it is necessary to accurately aim at the moving target device, which requires a suitable azimuth tracking solution as support.

[0005] The current wireless charging solutions mainly include short-distance fixed-point charging. For short-distance fixed-point wireless charging, common technologies include magnetic induction wireless charging. This method usually requires the transmitter and receiver to be very close and precisely aligned to achieve effective energy transfer. This technology has been widely used in AGV wireless charging.

[0006] As for wireless charging over longer distances, for example, Reach is developing a long-distance wireless power transmission that can achieve point-to-multipoint. Its system can cover a distance of tens of meters and is designed to provide uninterrupted power supply for devices such as unmanned vehicles and drones. In addition, the research team at Aalto University has developed a new theory that significantly improves the efficiency of long-distance wireless charging by optimizing the interaction between the transmitting and receiving antennas. The above wireless charging method achieves this goal by suppressing the radiation impedance and adjusting the phase of the antenna current, achieving a breakthrough in long-distance transmission efficiency of more than 80%.

[0007] The application scenario of the existing technology is to place a magnetic induction wireless charging transmitter at a fixed point. Whenever the AGV needs to be charged, it automatically cruises to the charging pile and charges after alignment. In order to maintain high charging efficiency, the AGV needs to be as close to the charging pile as possible. The power supply distance limit of most devices is 3cm-5cm. At the same time, the receiving surface of the magnetic induction wireless charging module is as parallel as possible to the surface of the transmitter. During the charging process, the system charging efficiency is less robust to the angle between the receiving surface and the surface of the transmitter and the effective charging area. As the angle between the two increases or the effective overlapping area becomes smaller, the charging efficiency drops sharply.

[0008] Based on the design principles of existing products, there are two main deficiencies: the power supply distance is too short. Once the limit distance is exceeded, the transmission will stop. The limit distance is generally at the centimeter level; the effective overlapping area requirements are high. When the angle is large or the offset is large, the power supply transmission will also stop. Summary of the invention

[0009] The present application provides an azimuth-following laser wireless energy transmission system based on AOA, which determines the target position through AOA algorithm and TOF algorithm, and uses a specific filtering algorithm to achieve azimuth following, so that the laser beam emitted by the laser transmitting end always falls on the surface of the photovoltaic cell at the receiving end, thereby realizing flexible and long-distance wireless charging.

[0010] The present application provides an AOA-based azimuth-following laser wireless energy transmission system for charging at least one target device, comprising:

[0011] A laser emitting end, comprising a laser source, a control unit, a base station, a steering gear platform, and a laser ranging module, wherein the laser source, the base station, the laser ranging module, and the steering gear platform are all electrically connected to the control unit; and

[0012] At least one laser receiving end, each of the laser receiving ends is correspondingly mounted to one of the target devices, the laser receiving end comprises a photovoltaic cell and a tag, the photovoltaic cell is used for photoelectric conversion, and the tag is used for transmitting a position signal of the laser receiving end;

[0013] The base station is capable of receiving a position signal of the tag, and the control unit obtains the arrival angle, the first distance and the signal strength based on the position signal, and calculates the azimuth and the following angle, and outputs a PWM signal to drive the servo gimbal to rotate in real time, so that the laser beam of the laser source is aimed at the target device; the laser ranging module is capable of measuring the second distance between the laser emitting end and the target device;

[0014] When the distance difference between the first distance and the second distance is less than or equal to a preset threshold, the laser beam of the laser source irradiates the surface of the photovoltaic cell, so that the laser receiving end can receive light energy and start charging.

[0015] Optionally, the laser ranging module includes a laser ranging sensor, and the laser ranging sensor can rotate synchronously with the servo gimbal.

[0016] Correspondingly, the present application also provides an azimuth-following laser wireless energy transmission method based on AOA, and at least one target device is charged by the above-mentioned azimuth-following laser wireless energy transmission based on AOA. The azimuth-following laser wireless energy transmission method based on AOA includes the following steps:

[0017] The tag at the laser receiving end is powered on and emits the location signal of the target device;

[0018] The base station receives a location signal from one of the tags;

[0019] The control unit obtains the arrival angle, the first distance and the signal strength based on the position signal analysis;

[0020] The control unit uses a filtering algorithm to calculate the azimuth and the following angle;

[0021] The control unit outputs a PWM signal to drive the servo gimbal and the laser ranging module to rotate synchronously in real time, so that the laser beam of the laser source is aimed at the target device;

[0022] The laser ranging module is capable of measuring a second distance between the laser emitting end and the target device;

[0023] The control unit calculates a distance difference between the first distance and the second distance;

[0024] It is determined whether the distance difference is less than or equal to a preset threshold. If so, the laser beam of the laser source is irradiated to the surface of the photovoltaic cell, so that the target device can receive light energy and start charging. If not, the control unit determines that there is an obstructing object between the laser emitting end and the target device, and the laser source cannot emit the laser beam.

[0025] Optionally, the step of obtaining the arrival angle, the first distance and the signal strength based on the position signal analysis by the control unit includes the following steps:

[0026] Direct memory access is used to transfer the frame data containing the position signal to the development board for analysis;

[0027] Filter the frame data to remove the influence of static errors and data jumps;

[0028] The development board reads the filtered frame data from the base station to the internal memory through direct memory access transmission, and parses the location information contained in the data, which includes the distance information obtained by the ranging positioning method based on the propagation time parameter, the angle information obtained by the AOA estimation positioning method based on the carrier phase, the first path signal strength indication, and the total received signal strength indication.

[0029] Optionally, the step of filtering the frame data to remove the influence of static errors and data jumps includes the following steps:

[0030] Perform mean processing on cache data at different distances;

[0031] When the target is stationary, the blind zone threshold of the angle response is selected by comparing the smooth curve fitted by the least square method with the measured angle data curve;

[0032] Set the blind zone threshold of the servo gimbal's response angle to the blind zone threshold of the selected angle response;

[0033] Get the current arrival angle data of the servo gimbal;

[0034] Determine whether the difference between the current arrival angle data and the next arrival angle data is less than the blind zone threshold. If so, determine that the next arrival angle data is a static error and filter it out. If not, the servo gimbal rotates to the next arrival angle data.

[0035] Optionally, when there is an obstruction on the straight path between the laser receiving end and the laser transmitting end, it is recorded as a non-line-of-sight state;

[0036] After the target device is able to receive light energy, charging begins. When a non-line-of-sight state is identified, the laser source is powered off to stop power transmission, and the servo gimbal continues to rotate following the laser receiving end.

[0037] Optionally, get the actual angular velocity of the target device w ;

[0038] The theoretical moving angular velocity can be calculated based on the known interval time of the arrival angle data. The theoretical moving angular velocity will be smaller than the actual moving angular velocity. w ;

[0039] Determine whether the theoretical angular velocity is greater than the actual angular velocity w If yes, filter out the theoretical moving angular velocity, if no, update the response angle of the servo gimbal to the arrival angle.

[0040] Optionally, before identifying the occurrence of the non-line-of-sight state, a first valid response angle is obtained according to a first path signal strength indication and a total received signal strength indication value of received data;

[0041] Among them, when the difference between the first path signal strength indication and the total received signal strength indication is less than 6dB, it is determined to be in the line-of-sight state, and the arrival angle in the frame data that meets the line-of-sight state is defined as the starting effective angle; when the difference between the first path signal strength indication and the total received signal strength indication is greater than 10dB, it is determined to be in the non-line-of-sight state.

[0042] Optionally, the theoretical moving angular velocity can be obtained according to the known adjacent interval durations of the arrival angle data, specifically including:

[0043] When N consecutive frames of data are judged as non-line-of-sight, the time N×20ms elapsed is counted and recorded as the time accumulation;

[0044] Get a new effective angle;

[0045] The difference between the new effective angle and the current effective angle is calculated and divided by the time accumulation amount to obtain the theoretical moving angular velocity.

[0046] Optionally, when the distance between the base station and the target device is less than 3m, it is defined as a close distance, and the obtained effective angle is compared with the blind zone threshold. The arrival angle greater than the blind zone threshold is directly set as the rotation angle of the servo response;

[0047] When the distance between the base station and the target device is greater than 3m, it is defined as a long distance. Different blind zone thresholds are divided according to different distances, and the temporarily stored effective angles in different distance areas are obtained; all effective angle data are averaged, and the calculated average is subtracted from the last rotation angle. If the difference between the two is greater than the blind zone threshold, it is set as the new rotation angle and the servo is driven to rotate.

[0048] The present application provides an azimuth-following laser wireless energy transmission system based on AOA. This design relies on the unique advantages of the arrival angle positioning technology based on the ultra-wideband wireless communication technology module, combined with the needs of laser wireless energy transmission, to develop an azimuth-following laser wireless energy transmission system. This system not only inherits the powerful capabilities of ultra-wideband wireless communication technology in precise positioning, but also overcomes the limitations of distance restrictions and charging methods in traditional wireless charging technology, and realizes long-distance following charging of the target in a moving state. Since the laser wireless charging solution has good robustness to angle changes, it can maintain stable transmission efficiency within a wider angle range. When multiple targets such as AGVs appear within the following range, the power supply and power off of the tag are controlled by detecting the power of multiple AGVs, searching for AGVs that need to be charged, and realizing the time-sharing use of the same charging pile to meet application needs in complex environments. BRIEF DESCRIPTION OF THE DRAWINGS

[0049] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For those skilled in the art, other drawings can be obtained based on these drawings without creative work.

[0050] Figure 1 This is a diagram of an AOA-based azimuth-following laser wireless energy transmission system provided by the present application;

[0051] Figure 2 is the static error diagram provided by this application;

[0052] Figure 3 This is the actual scenario application of the AOA-based azimuth-following laser wireless energy transmission system provided by this application;

[0053] Figure 4 It is a schematic diagram of the line-of-sight state in the AOA-based azimuth-following laser wireless energy transmission system provided by the present application;

[0054] Figure 5 It is a schematic diagram of the non-line-of-sight state in the AOA-based azimuth-following laser wireless energy transmission system provided by the present application;

[0055] Figure 6 It is a schematic diagram of angle transformation under different occlusion conditions in the AOA-based azimuth-following laser wireless energy transmission system provided by the present application;

[0056] Figure 7 It is a schematic diagram of the actual motion angular velocity in the AOA-based azimuth-following laser wireless energy transmission system provided by the present application;

[0057] Figure 8 This is a flow chart of the AOA-based azimuth-following laser wireless energy transmission method provided in this application. DETAILED DESCRIPTION

[0058] The technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those skilled in the art without making creative work are within the scope of protection of the present application. In addition, it should be understood that the specific implementation methods described herein are only used to illustrate and explain the present application and are not used to limit the present application. In the present application, unless otherwise stated, the directional words used, such as "up", "down", "left", and "right", generally refer to the up, down, left, and right of the device in actual use or working state, specifically the drawing direction in the accompanying drawings.

[0059] The present application provides an azimuth-following laser wireless energy transmission system based on AOA, which is described in detail below. It should be noted that the description order of the following embodiments does not limit the preferred order of the embodiments of the present application. In the following embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, please refer to the relevant description of other embodiments.

[0060] See also Figure 1-Figure 7 The present application provides an AOA-based azimuth-following laser wireless energy transmission system for charging at least one target device. In this embodiment, the target device refers to an AGV or the like.

[0061] The AOA-based azimuth-following laser wireless energy transmission system mainly consists of two parts, namely a laser transmitting end and at least one laser receiving end, each of which is correspondingly installed on a target device. Among them, the laser transmitting end includes a laser source, a control unit, a base station, a steering gear pan / tilt, a safety device, a laser ranging module and its supporting power supply module. The above-mentioned laser source, base station, steering gear pan / tilt, safety device, laser ranging module and its supporting power supply module are all electrically connected to the control unit.

[0062] The main components of each laser receiving end include a photovoltaic cell and a tag. The photovoltaic cell is used for photoelectric conversion, and the tag is used to emit the position signal of the laser receiving end.

[0063] The laser source consists of two parts: a controllable laser and a laser collimator. As the core component of the laser source, the laser converts electrical energy into light energy of a certain wavelength. When building a laser wireless energy transmission system, a suitable laser wavelength will improve the overall efficiency and charging power of the system. The choice of wavelength also needs to match the working wavelength of the photovoltaic cell at the laser receiving end to ensure the maximum efficiency of energy transmission. In order to meet the continuous charging needs in this design, the laser emission source model used is the MGL-U-532-1W EB20429 all-solid-state laser (DPL).

[0064] At the current technological level, photovoltaic cell technology is the most mature and efficient choice for achieving long-distance high-power transmission. The choice of photovoltaic cells must be adapted to the wavelength of the laser source. This design uses gallium arsenide photovoltaic cells as the material for the receiving end to achieve light-to-electricity conversion, and finally connects the output end of the photovoltaic cell to the target device for charging.

[0065] The laser receiving end controls the power on and off of the tag to achieve target selection, which is simple and easy to use. The use process of this embodiment begins with powering the tag of the selected target. Then the base station located at the laser transmitting end begins to receive the location signal of the tag, the control unit parses the received data packet to obtain the arrival angle, the first distance and the signal strength data, obtains the azimuth following angle through the filtering algorithm, and outputs the PWM signal to drive the servo gimbal to rotate in real time, so that the laser beam of the laser source is aimed at the target device. After aiming at the target device, the laser ranging module can measure the second distance between the laser transmitting end and the target device. By comparing the difference between the second distance measured by the laser ranging module and the first distance previously analyzed, it is determined whether there is an obstructing object between the laser source and the target device to be charged. When the distance difference between the first distance and the second distance is less than or equal to a preset threshold, the preset threshold in this embodiment is preferably 10cm. If the distance difference is within the range of the preset threshold, the laser beam of the laser source irradiates the surface of the photovoltaic cell, so that the laser receiving end can start charging after receiving light energy, otherwise the laser source does not work and waits for the target device to leave.

[0066] The laser ranging module includes a laser ranging sensor, which can rotate synchronously with the servo gimbal.

[0067] The AOA-based azimuth-following laser wireless energy transmission system can meet the time-sharing use of multiple target devices in the same scene. It is different from the machine vision-based follow-up charging solution, which requires finding a charging target with features. When two or more tags are powered on at the same time as the base station, they will be automatically paired, but only one base station can be used with one tag each time. If time-sharing power supply is required, the previous tag must be powered off first. When the designated device needs power, the tag worn by the device can be powered, ultimately achieving time-sharing power transmission for different targets.

[0068] See also Figure 1-Figure 8 , a method for azimuth-following laser wireless energy transmission based on AOA, comprising the following steps:

[0069] S100, the tag at the laser receiving end is powered on and emits a location signal of the target device;

[0070] S200, the base station receives a location signal from one of the tags;

[0071] S300, the control unit obtains the arrival angle, the first distance and the signal strength based on the position signal analysis;

[0072] Step S300 includes the following steps:

[0073] S310, using direct memory access to transfer the frame data containing the position signal to the development board for parsing;

[0074] S320, filtering the frame data to remove the influence of static errors and data jumps;

[0075] S330. The development board reads the filtered frame data from the base station to the internal memory through direct memory access transmission, and parses the location information contained in the data, where the location information includes the distance information obtained by the ranging positioning method based on the propagation time parameter, the angle information obtained by the AOA estimation positioning method based on the carrier phase, the first path signal strength indication, and the total received signal strength indication.

[0076] S400, the control unit calculates and obtains the azimuth and the following angle using a filtering algorithm;

[0077] S500, the control unit outputs a PWM signal to drive the servo gimbal and the laser ranging module to rotate synchronously in real time, so that the laser beam of the laser source is aimed at the target device;

[0078] S600: The laser ranging module is capable of measuring a second distance between the laser emitting end and the target device;

[0079] S700, the control unit calculates the distance difference between the first distance and the second distance;

[0080] S800, determine whether the distance difference is less than or equal to a preset threshold value. If so, the laser beam of the laser source irradiates the surface of the photovoltaic cell, so that the target device can receive light energy and start charging. If not, the control unit determines that there is an obstructing object between the laser emitting end and the target device, and the laser source cannot emit the laser beam.

[0081] The AOA-based azimuth-following laser wireless energy transmission system implements time-of-flight (TOF) ranging and angle-of-arrival (AOA) direction-finding based on ultra-wideband wireless communication technology (UWB). Ultra-wideband wireless communication technology (UWB) is a carrier-free communication technology that uses a short sequence of energy pulses as the signal carrier for the above two algorithms. ToF (Time of flight) is a time-of-flight method that continuously transmits pulse signals to the object being measured, then receives the pulses reflected from the object, and calculates the distance of the object being measured from the detector by detecting the flight (round-trip) time of the pulse. AOA (Angle of Arrival) calculates AOA by measuring the arrival time difference of signals from the same source at different receiving antennas.

[0082] The step of filtering the frame data to remove the influence of static errors and data jumps includes the following steps:

[0083] S321, performing mean processing on cache data at different distances;

[0084] S322, when the target is stationary, selecting a blind zone threshold of the angle response by comparing a smooth curve fitted by the least squares method with the measured angle data curve;

[0085] S323, setting the blind zone threshold of the response angle of the servo gimbal to the blind zone threshold of the selected angle response;

[0086] S324, obtaining the current arrival angle data of the servo gimbal;

[0087] S325, determine whether the difference between the current arrival angle data and the next arrival angle data is less than the blind zone threshold, if so, determine that the next arrival angle data is a static error and filter it out, if not, the servo gimbal rotates to the next arrival angle data.

[0088] The location information of the target device is obtained by obtaining the horizontal angle, straight-line distance and received signal strength information of the tag relative to the base station, which is applicable to a variety of scenarios. As two parts of this module, the tag and the base station set parameters through the host computer (NAssistant) to achieve adaptation and establish data communication. The sent data is then parsed through the STM32F103 development board, and the blind area threshold required for filtering is obtained based on the least squares method. The bad pixel data is filtered by combining the received signal strength and the adjacent angular velocity accumulated over time, and the static error and the data jump caused by non-line-of-sight conditions are removed, so as to obtain the horizontal angle that the servo needs to rotate, control the servo to the required angle, and achieve target tracking.

[0089] In this system, after the base station obtains the location information of the tag, direct memory access (DMA) is used to transfer the frame data containing the location information to the STM32mini development board for subsequent data processing and control of the following system rotation. After the STM32 development board reads the data from the base station to the internal memory through DMA transmission, it needs to parse the location information contained in the data. The location information used subsequently mainly includes three categories:

[0090] (1) Distance information obtained by the ranging positioning method based on the propagation time parameter (Distance);

[0091] (2) Angle information (Angle) obtained by the AOA estimation positioning method based on carrier phase;

[0092] (3) First path signal strength indication (FP_RSSI) and total received signal strength indication (RX_RSSI).

[0093] The purpose of ranging is to set the data depth when taking the average later. The array depth is 2 in the 3~10m area, 4 in the 10~50m area, and 8 in the area above 50m. The depth represents the effective angle of temporary storage. For example, in the area above 50m, 8 consecutive effective values ​​will be temporarily stored, and the average value will be taken after the data is full to reduce the impact of static errors. And by comparing with the distance data measured by the laser ranging module, it is determined whether there are obstacles on the charging path. If the distance measured by the laser ranging module is smaller than the distance measured by the UWB module, it means that there are obstacles on the laser path, and the laser source should be turned off at this time.

[0094] Direction finding is to obtain the angle data of the target relative to the base station. The data basis for subsequent target tracking is obtained by direction finding.

[0095] The frame data format read by the development board from the base station is shown in Table 1. After parsing the frame data, the data needs to be filtered to remove the influence of static errors and data jumps.

[0096] Table 1 One frame data format

[0097] name Length (Bytes) Data (hexadecimal) Frame Header 1 55 Function Mark 1 07 Frame Length 2 21 00 Role 1 01 ID 1 00 Local Time 4 d9 e4 00 00 System Time 4 00 00 00 00 Reserved 4 00 00 8c e6 Voltage * 1000 2 b1 12 Valid Node 1 01 Role 1 01 ID 1 00 Distance × 1000 3 e6 0e 00 Angle × 100 2 b7 07 FP_RSSI × (-2) 1 a3 RX_RSSI × (-2) 1 9c Reserved 3 14 00 73

[0098] There are two aspects of error that affect angle data. First, when the tag remains stationary, there will be a static error of ±5° in the angle. Second, when the system is in a non-line-of-sight (NLOS) state due to, for example, occlusion or misalignment between the tag and the base station, the angle data will jump.

[0099] Taking the arrival angle as an example, we can obtain Figure 2From the angle data shown, it can be found that when the target is stationary, the position data is not stable, but has irregular fluctuations. If such data is used directly for target following, the servo will swing back and forth, affecting the stability of the system. To address this problem, this study proposes a blind spot threshold screening based on the least squares method. First, the cached data at different distances are averaged, and then the angle data with an angle difference less than the blind spot threshold is removed through threshold screening, thereby improving the following stability.

[0100] When the target is stationary, the angle response blind threshold of 3.3° is selected by comparing the smooth curve fitted by the least squares method with the measured angle data curve to reduce the impact of data fluctuations in the static state on the overall stability of the system. By setting the blind threshold of the servo response angle, when the difference between the two following angle data is less than the blind threshold, the angle is determined to be a static error and filtered out to alleviate the frequent rotation of the following device due to the irregular fluctuation of the angle data measured by AOA in the static state of the target, thereby affecting the stability of the system and even losing the following target. For example, when the previous servo response angle is 5°, the next arrival angle data is 6°, and the difference between the two is less than 3.3°, the angle does not respond. On the contrary, when the next arrival angle data is 9°, it exceeds 3.3°, and the servo immediately rotates to the 9° position. In addition, according to the distance between the tag and the base station, different numbers of arrival angles are cached for average processing, and then the difference is made with the previous servo response angle to see if it is less than 3.3° to control the next action of the servo.

[0101] When there is an obstruction on the straight path between the laser receiving end and the laser emitting end, it is recorded as a non-line-of-sight state; after the target device is able to receive light energy, charging begins. When the non-line-of-sight state is recognized, the laser source is powered off and power transmission is stopped, and the servo gimbal continues to rotate with the laser receiving end.

[0102] Since the recognition range of the base station is limited, usually between ±60°, the accuracy decreases as the deviation angle increases. When there is an obstruction between the base station and the target device, such as Figure 3 The car is shown behind a wall. At this time, the laser source is powered off and stops transmitting power. However, it needs to continue following the vehicle to prevent the target from exceeding the recognition range and causing the target to be lost. This involves the recognition of the NLOS state, i.e., the non-line-of-sight state, i.e., the situation where there is an obstruction on the straight path between the receiving end and the transmitting end. Figure 4 and Figure 5 As shown, the period data will appear as Figure 6From the changes shown, we can find that the occlusion has different degrees of influence on the measurement results of the position data at different positions, and there is no periodicity. When following the moving target device, this algorithm measures the angular velocity of adjacent measurement points accumulated over time, identifies the non-line-of-sight situation, sets the threshold with reference to the maximum angular velocity of the following target device, and removes the measurement points outside the threshold, thereby alleviating the data transition of the AOA angle data in the non-line-of-sight situation. The basic idea is as follows Figure 7 shown.

[0103] Get the actual angular velocity of the target device w ;

[0104] The theoretical moving angular velocity can be calculated based on the known interval time of the arrival angle data. The theoretical moving angular velocity will be smaller than the actual moving angular velocity. w ;

[0105] Determine whether the theoretical angular velocity is greater than the actual angular velocity w If yes, filter out the theoretical moving angular velocity, if no, update the response angle of the servo gimbal to the arrival angle.

[0106] In real-world scenarios, the target device's angular velocity has an upper limit, which is tentatively set at w ,like Figure 6 As shown in the figure, we have obtained the arrival angle data. According to the known interval length of adjacent data, the theoretical moving angular velocity can be obtained. Under normal circumstances, the theoretical moving angular velocity will be smaller than the actual moving angular velocity. When there is occlusion, the data will jump, which will cause the theoretical moving angular velocity to be much larger than the actual moving angular velocity. At this time, the arrival angle is not ideal data and is filtered out. This is used as the basic principle for data screening in non-line-of-sight conditions.

[0107] The basic idea of ​​the filtering algorithm for angular velocity measurement of adjacent arrival angles under time accumulation in this embodiment is given here with a specific example of "time accumulation" and "adjacent arrival angles". First, assuming that the theoretical moving angular velocity is 5° / s, ten arrival angle data are recorded as follows: "1.00°, 1.06°, 1.09°, 1.13°, 1.21°, 1.53°, 1.77°, 1.48°, 1.54°, 1.60°", and the data interval is 20ms. The four theoretical angular velocities obtained from the first five data are 3° / s, 1.5° / s, 2° / s, and 4° / s, respectively. These four theoretical moving angular velocities are less than the actual angular velocity of 5° / s, so they are all The final updated effective angle is 1.21°, but the theoretical angular velocity calculated with 1.53° is (1.53-1.21) / 0.02=16° / s, which is much higher than 5° / s. 1.53° is filtered out, and the effective angle is not updated, which is still 1.21°. The next angle is 1.77°, and the time interval should be accumulated to 40ms. Therefore, the theoretical moving angular velocity is (1.77-1.21) / 0.04=14° / s, which is still higher than 5° / s and is filtered out. The next data 1.48° and the effective angle 1.21° are judged, and the theoretical moving angular velocity is (1.48-1.21) / 0.06=4.5° / s, which is less than the actual moving angular velocity. At this time, the effective angle is updated to 1.485°, and the next theoretical moving angular velocity is (1.54-1.48) / 0.02=3° / s. The effective angle is updated to 1.54°, (1.6-1.54) / 0.02=3° / s, and the final effective angle is 1.6°. In this way, 1.53° and 1.77° are screened out from the ten data. In fact, these two data are also caused by non-line-of-sight conditions. Time accumulation refers to the accumulation of data intervals between effective angles, and adjacent arrival angles refer to adjacent effective arrival angle data that meet the filtering algorithm.

[0108] In this design, the arrival time interval of serial data is 20ms. The microcontroller obtains the position information of the tracking target every 20ms, including arrival angle, straight-line distance, received signal strength and other data. Each dot in the figure refers to a frame of data received and parsed by the microcontroller.

[0109] Before identifying the non-line-of-sight state, it is necessary to determine the first valid response angle. According to the first path signal strength indicator (FP_RSSI) and the total received signal strength indicator (RX_RSSI) values ​​of the received data, in general, when "FP_RSSI - RX_RSSI" is less than 6dB, it is likely to be in the LoS state, and when it is greater than 10dB, it is likely to be in the NLoS or multipath state. Therefore, in the initialization calibration phase, it is theoretically necessary to ensure that there are no obstructions between the tracking target and the base station. At this time, the first arrival angle in the frame data that satisfies "FP_RSSI - RX_RSSI" less than 6dB is used as the starting valid angle. After actual scene verification, even if the device is in the NLoS state, it does not affect subsequent use.

[0110] After calibration, the first effective angle is obtained. After that, it is necessary to identify the impact of non-line-of-sight state in motion and static state on the system following stability. When new data arrives, the difference between the effective angle and the time accumulation is calculated to obtain the angular velocity at this time. When the angular velocity is greater than the actual angular velocity of the target being followed, it is determined that this frame of data is a data transition phenomenon caused by non-line-of-sight or multipath state, and the frame of data is discarded.

[0111] The definition of time accumulation is as follows: when N consecutive frames of data are determined to be measured under non-line-of-sight conditions, these N frames of data are discarded and the time N×20ms elapsed is counted. When the angular velocity of the next frame of data arrives, if it is less than the angular velocity threshold of the actual motion, the arrival angle at this moment is set as the new effective angle for next use, and the total time N×20ms elapsed at this moment is the time accumulation.

[0112] The theoretical moving angular velocity can be obtained based on the known adjacent interval duration of the arrival angle data, including:

[0113] When N consecutive frames of data are judged as non-line-of-sight, the time N×20ms elapsed is counted and recorded as the time accumulation;

[0114] Get a new effective angle;

[0115] The difference between the new effective angle and the current effective angle is calculated and divided by the time accumulation amount to obtain the theoretical moving angular velocity.

[0116] After obtaining the effective angle, it is necessary to determine the rotation angle required to control the rotation of the servo. The selection of the rotation angle is mainly divided into two categories: far and near based on the distance between the tracking target and the base station.

[0117] When the distance between the target to be followed and the base station is less than 3m, it is considered to be close distance. In this case, the effective angle obtained by the above method is compared with the blind zone threshold, and the arrival angle greater than the blind zone threshold is directly set as the rotation angle of the servo response.

[0118] When the distance between the target and the base station is greater than 3m, it is classified as long distance. Unlike the short distance classification, a single blind zone threshold is no longer set for long distance, but different blind zone thresholds are divided according to different distances. After identifying the NLoS state, the effective angle obtained is stored in arrays of different depths according to the distance division area. In this article, the array depth is 2 in the 3~10m area, 4 in the 10~50m area, and 8 in the area above 50m. The depth represents the temporary storage of effective angles. For example, in the area above 50m, 8 consecutive effective values ​​will be temporarily stored, and the average of the data after being stored is taken, that is, it is realized through the shift operation. The array with a depth of 8 can be shifted right by three places after taking the sum, and the shift operation will also save logical resources. After that, the calculated average value is subtracted from the previous rotation angle. If the difference between the two is greater than the blind zone threshold, it is set as the new rotation angle and the servo is driven to rotate.

[0119] Finally, the rotation angle of each time is output to the servo through the STM32mini development board in the form of PWM signal, which controls the servo to rotate left and right, thus realizing the follow-up charging of the target device AGV.

[0120] The laser distance sensor is turned together with the servo, and the laser distance is compared with the distance data received by the base station to assist in judging whether the light path is blocked by foreign objects or the charging target is lost during the charging process. When these situations occur, the system can respond quickly and turn off the laser emission to minimize the potential risks that may be caused by the laser.

[0121] This design relies on the unique advantages of AOA positioning technology based on UWB module, combined with the needs of laser wireless energy transmission, to develop a set of azimuth-following laser wireless energy transmission system. This system not only inherits the powerful ability of UWB technology in precise positioning, but also overcomes the limitations of distance and charging methods in traditional wireless charging technology, and realizes long-distance following charging of the target in a moving state. Since the laser wireless charging solution has good robustness to angle changes, it can maintain stable transmission efficiency in a wide angle range. When multiple targets such as AGVs appear in the following range, the power supply and power off of the tag are controlled by detecting the power of multiple AGVs, searching for AGVs that need to be charged, and realizing the time-sharing use of the same charging pile to meet the application needs in complex environments.

[0122] This embodiment combines the least squares method with the angular velocity measurement algorithm of adjacent points under time accumulation, and can identify and alleviate the NLoS state without relying on prior knowledge, thereby improving the accuracy and stability of target following, having strong generalization ability, and being able to adapt to most working environments.

[0123] The AOA-based azimuth-following laser wireless energy transmission system organically combines laser wireless power transmission with the AOA azimuth-following algorithm, which not only achieves a longer transmission distance, but also ensures the accuracy of laser transmission, enriching the mobile robot's support for multi-target monitoring within the detection range. When multiple devices to be charged appear within the following range, the charging target can be selected by time-sharing power supply to the cooperative devices. In addition, the TOF ranging algorithm cooperates with the laser ranging module to not only assist in identifying the NLoS state, but also realizes obstacle detection on the laser path, avoiding the occurrence of safety hazards.

[0124] The above is a detailed introduction to the AOA-based azimuth-following laser wireless energy transmission system provided by the present application. Specific examples are used in this article to illustrate the principles and implementation methods of the present application. The description of the above embodiments is only used to help understand the method of the present application and its core idea; at the same time, for general technical personnel in this field, according to the idea of ​​the present application, there will be changes in the specific implementation method and application scope. In summary, the content of this specification should not be understood as a limitation on the present application.

Claims

1. AOA-based azimuth-following laser wireless energy transmission method, It is characterized in that The following steps are involved: The tag at the laser receiving end is powered on and emits the location signal of the target device; The base station receives a location signal from one of the tags; The control unit obtains the arrival angle, the first distance and the signal strength based on the position signal analysis; The control unit uses a filtering algorithm to calculate the azimuth and the following angle; The control unit outputs a PWM signal to drive the servo gimbal and the laser ranging module to rotate synchronously in real time, so that the laser beam of the laser source is aimed at the target device; The laser ranging module can measure a second distance between the laser emitting end and the target device; The control unit calculates a distance difference between the first distance and the second distance; It is determined whether the distance difference is less than or equal to a preset threshold. If so, the laser beam of the laser source is irradiated to the surface of the photovoltaic cell, so that the target device can receive light energy and start charging. If not, the control unit determines that there is an obstructing object between the laser emitting end and the target device, and the laser source cannot emit the laser beam. The step of obtaining the arrival angle, the first distance and the signal strength based on the position signal analysis by the control unit includes the following steps: Direct memory access is used to transfer the frame data containing the position signal to the development board for analysis; Filter the frame data to remove the influence of static errors and data jumps; The development board reads the filtered frame data from the base station to the internal memory through direct memory access transmission, and parses the location information contained in the data, which includes the distance information obtained by the ranging positioning method based on the propagation time parameter, the angle information obtained by the AOA estimation positioning method based on the carrier phase, the first path signal strength indication, and the total received signal strength indication. The step of filtering the frame data to remove the influence of static errors and data jumps includes the following steps: Perform mean processing on cache data at different distances; When the target is stationary, the blind zone threshold of the angle response is selected by comparing the smooth curve fitted by the least square method with the measured angle data curve; Set the blind zone threshold of the servo gimbal's response angle to the blind zone threshold of the selected angle response; Get the current arrival angle data of the servo gimbal; Determine whether the difference between the current arrival angle data and the next arrival angle data is less than the blind zone threshold. If so, determine that the next arrival angle data is a static error and filter it out. If not, the servo gimbal rotates to the next arrival angle data.

2. According to the AOA-based azimuth-following laser wireless energy transmission method of claim 1, It is characterized in that When there is an obstruction on the straight path between the laser receiving end and the laser transmitting end, it is recorded as a non-line-of-sight state; After the target device is able to receive light energy, charging begins. When a non-line-of-sight state is identified, the laser source is powered off to stop power transmission, and the servo gimbal continues to rotate following the laser receiving end.

3. According to claim 2, the AOA-based azimuth-following laser wireless energy transmission method, It is characterized in that Get the actual angular velocity of the target device w ; The theoretical moving angular velocity can be calculated based on the known interval time of the arrival angle data. The theoretical moving angular velocity will be smaller than the actual moving angular velocity. w ; Determine whether the theoretical angular velocity is greater than the actual angular velocity w If yes, filter out the theoretical moving angular velocity, if no, update the response angle of the servo gimbal to the arrival angle.

4. According to claim 3, the AOA-based azimuth-following laser wireless energy transmission method, It is characterized in that Before identifying the occurrence of the non-line-of-sight state, obtaining a first valid response angle according to the first path signal strength indication and the total received signal strength indication value of the received data; Among them, when the difference between the first path signal strength indication and the total received signal strength indication is less than 6dB, it is determined to be in the line-of-sight state, and the arrival angle in the frame data that meets the line-of-sight state is defined as the starting effective angle; when the difference between the first path signal strength indication and the total received signal strength indication is greater than 10dB, it is determined to be in the non-line-of-sight state.

5. According to claim 4, the AOA-based azimuth-following laser wireless energy transmission method, It is characterized in that The theoretical moving angular velocity can be obtained according to the known adjacent interval duration of the arrival angle data, specifically including: When N consecutive frames of data are judged as non-line-of-sight, the time N×20ms elapsed is counted and recorded as the time accumulation; Get a new effective angle; The difference between the new effective angle and the current effective angle is calculated and divided by the time accumulation amount to obtain the theoretical moving angular velocity.

6. According to claim 4, the AOA-based azimuth-following laser wireless energy transmission method, It is characterized in that When the distance between the base station and the target device is less than 3m, it is defined as a close distance. The effective angle obtained is compared with the blind zone threshold. The arrival angle greater than the blind zone threshold is directly set as the rotation angle of the servo response; When the distance between the base station and the target device is greater than 3m, it is defined as a long distance. Different blind zone thresholds are divided according to different distances, and the temporarily stored effective angles in different distance areas are obtained; all effective angle data are averaged, and the calculated average is subtracted from the last rotation angle. If the difference between the two is greater than the blind zone threshold, it is set as the new rotation angle and the servo is driven to rotate.

7. An AOA-based azimuth-following laser wireless energy transmission system, using the AOA-based azimuth-following laser wireless energy transmission method according to any one of claims 1 to 6, for charging at least one target device, It is characterized in that include: A laser emitting end, comprising a laser source, a control unit, a base station, a steering gear platform, and a laser ranging module, wherein the laser source, the base station, the laser ranging module, and the steering gear platform are all electrically connected to the control unit; and At least one laser receiving end, each of the laser receiving ends is correspondingly mounted to one of the target devices, the laser receiving end comprises a photovoltaic cell and a tag, the photovoltaic cell is used for photoelectric conversion, and the tag is used for transmitting a position signal of the laser receiving end; The base station is capable of receiving a position signal of the tag, and the control unit obtains the arrival angle, the first distance and the signal strength based on the position signal, and calculates the azimuth and the following angle, and outputs a PWM signal to drive the servo gimbal to rotate in real time, so that the laser beam of the laser source is aimed at the target device; the laser ranging module is capable of measuring the second distance between the laser emitting end and the target device; When the distance difference between the first distance and the second distance is less than or equal to a preset threshold, the laser beam of the laser source irradiates the surface of the photovoltaic cell, so that the laser receiving end can receive light energy and start charging.

8. According to claim 7, the AOA-based azimuth-following laser wireless energy transmission system, It is characterized in that The laser distance measurement module includes a laser distance measurement sensor, and the laser distance measurement sensor can rotate synchronously with the steering gear gimbal.