CN105262154A - Wireless charging system for underwater robot and control method of wireless charging system - Google Patents
Wireless charging system for underwater robot and control method of wireless charging system Download PDFInfo
- Publication number
- CN105262154A CN105262154A CN201510541749.1A CN201510541749A CN105262154A CN 105262154 A CN105262154 A CN 105262154A CN 201510541749 A CN201510541749 A CN 201510541749A CN 105262154 A CN105262154 A CN 105262154A
- Authority
- CN
- China
- Prior art keywords
- circuit
- receiving end
- transmitter
- underwater robot
- current
- 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.)
- Pending
Links
Landscapes
- Charge And Discharge Circuits For Batteries Or The Like (AREA)
Abstract
本发明公开了一种水下机器人无线充电系统及其控制方法,所述水下无线充电系统包括耦合连接的发射端系统和接收端系统,所述发射端系统包括了顺序连接的电源系统、交流转换系统以及发射端的谐振电路;述接收端系统包括接收端谐振电路、接收端直流转换电路以及接收端负载匹配电路;所述能量控制方法包括机器人充电控制和充电功率控制算法,本发明利用电磁感应原理对水下机器人进行无线充电,同时设计了一种能量控制方法,实现了对水下机器人充电的控制,实现低电荷量情况下恒功率充电以及充满断电的控制。
The invention discloses a wireless charging system for an underwater robot and a control method thereof. The underwater wireless charging system includes a coupled transmitting end system and a receiving end system, and the transmitting end system includes a sequentially connected power supply system, an AC conversion system and a resonant circuit at the transmitting end; the receiving end system includes a receiving end resonant circuit, a receiving end DC conversion circuit and a receiving end load matching circuit; the energy control method includes a robot charging control and a charging power control algorithm, and the present invention utilizes electromagnetic induction The principle is to wirelessly charge the underwater robot. At the same time, an energy control method is designed to realize the control of the charging of the underwater robot, and realize the constant power charging under the condition of low charge and the control of full power failure.
Description
技术领域 technical field
本发明属于水下充电系统及其控制技术,特别是一种水下机器人无线充电系统及其控制方法。 The invention belongs to an underwater charging system and its control technology, in particular to an underwater robot wireless charging system and its control method.
背景技术 Background technique
随着技术的普及,水下机器人的技术被越来越广泛地应用到民用领域,而对于水下机器人的供电方式较为单一,多为插拔式充电和更换电池,这种充电方式存在一系列的缺点:(1)每次插拔式充电都需要将水下机器人从水底上浮进行充电,大大缩短了水下机器人在水下的工作时间;(2)频繁的插拔式充电会使接口老化,带来安全隐患;(3)多次的电池更换大大减少了机器的寿命。 With the popularization of technology, the technology of underwater robots is more and more widely used in the civilian field, and the power supply method for underwater robots is relatively simple, mostly plug-in charging and battery replacement. Disadvantages: (1) Each plug-in charging requires the underwater robot to be charged from the bottom of the water, which greatly shortens the working time of the underwater robot underwater; (2) Frequent plug-in charging will make the interface aging , bringing potential safety hazards; (3) multiple battery replacements greatly reduce the life of the machine.
发明内容 Contents of the invention
本发明的目的在于提供一种水下机器人无线充电系统及其控制方法,提高电路工作的安全性和能量的传输效率,同时对水下机器人的电池进行能量管理,增加水下机器人在水下的工作时间,无接口充电增加水下机器人的安全性,增大电池的使用寿命。 The purpose of the present invention is to provide a wireless charging system for an underwater robot and its control method, which can improve the safety of the circuit work and the transmission efficiency of energy, and at the same time manage the energy of the battery of the underwater robot to increase the underwater life of the underwater robot. During working hours, charging without an interface increases the safety of the underwater robot and increases the service life of the battery.
实现本发明目的的技术解决方案为:一种水下机器人无线充电系统,包括主电路和控制电路,所述主电路包括耦合连接的发射端主电路和接收端主电路,所述发射端主电路包括顺序连接的发射端直流电源系统、发射端交流转换系统以及发射端谐振电路,所述接收端主电路包括顺序连接的接收端谐振电路、接收端直流转换电路以及接收端负载匹配变换电路; The technical solution to realize the object of the present invention is: a wireless charging system for an underwater robot, including a main circuit and a control circuit, the main circuit includes a coupling-connected transmitting end main circuit and a receiving end main circuit, and the transmitting end main circuit It includes a sequentially connected transmitting-end DC power supply system, a transmitting-end AC conversion system, and a transmitting-end resonant circuit, and the receiving-end main circuit includes a sequentially connected receiving-end resonant circuit, a receiving-end DC conversion circuit, and a receiving-end load matching transformation circuit;
所述控制电路包括发射端控制电路和接收端控制电路,发射端控制电路包括分别连接在发射端数字信号处理器DSP上的发射端PWM驱动电路和发射端电流采样电路,该发射端电流采样电路连接在发射端谐振电路上;所述接收端控制电路包括分别连接在接收端数字信号处理器DSP上的接收端PWM驱动电路、接收端两路电压采样电路和接收端电流采样电路,所述接收端两路电压采样电路的接收端第一电压采样电路接在接收端直流转换电路的输出端,接收端第二电压采样电路串联连接在水下机器人电池正极和负极之间,所述接收端电流采样电路串联连接在水下机器人电池正极O与接收端负载匹配变换电路出书的正极P之间。 The control circuit includes a transmitter control circuit and a receiver control circuit, the transmitter control circuit includes a transmitter PWM drive circuit and a transmitter current sampling circuit respectively connected to the transmitter digital signal processor DSP, the transmitter current sampling circuit Connected on the resonant circuit at the transmitting end; the receiving end control circuit includes a receiving end PWM drive circuit connected respectively on the receiving end digital signal processor DSP, two voltage sampling circuits at the receiving end and a receiving end current sampling circuit, the receiving end The first voltage sampling circuit at the receiving end of the two-way voltage sampling circuit at the receiving end is connected to the output end of the DC conversion circuit at the receiving end, and the second voltage sampling circuit at the receiving end is connected in series between the positive pole and the negative pole of the battery of the underwater robot. The sampling circuit is connected in series between the positive pole O of the battery of the underwater robot and the positive pole P of the load matching conversion circuit at the receiving end.
一种水下机器人无线充电系统的控制方法,首先,检测发射端谐振电路的电流,通过发射端谐振电路的电流变化判定接收端是否接入电路,即负载检测,若发射端检测到接收端接入电路后,发射端数字信号处理器DSP发出充电指令,电路进入工作状态,通过发射端PWM驱动电路控制发射端交流转换系统输出交流电,经过发射端谐振电路将电能传输到接收端,接收端通过接收端谐振电路接收发射端传输来的能量,并把这些能量转变为交流电输出,经过接收端直流转换电路以及接收端负载匹配电路后,对水下机器人电池进行充电,若发射端检测到接收端离开电路或者接收端水下机器人电池电量充满后,发射端数字信号处理器DSP发出停止充电的指令,并将控制发射端主电路电路回归检测模式运行; A control method for an underwater robot wireless charging system. First, detect the current of the resonant circuit at the transmitting end, and determine whether the receiving end is connected to the circuit through the current change of the resonant circuit at the transmitting end, that is, load detection. If the transmitting end detects that the receiving end is connected After entering the circuit, the digital signal processor DSP at the transmitting end issues a charging command, and the circuit enters a working state. The AC conversion system at the transmitting end is controlled by the PWM drive circuit at the transmitting end to output AC power, and the power is transmitted to the receiving end through the resonant circuit at the transmitting end. The receiving end passes through The resonant circuit at the receiving end receives the energy transmitted by the transmitting end, and converts the energy into AC output. After passing through the DC conversion circuit at the receiving end and the load matching circuit at the receiving end, it charges the battery of the underwater robot. If the transmitting end detects that the receiving end After leaving the circuit or the battery of the underwater robot at the receiving end is fully charged, the digital signal processor DSP at the transmitting end issues an instruction to stop charging, and will control the main circuit at the transmitting end to return to the detection mode;
其次,在电路工作时发射端电流采样电路对发射端谐振电路的电流进行采样,通多对发射端谐振电路的电流进行采样,通过采样电流的值与零值相比较,通过比较的值,改变发射端数字信号处理器DSP发出的PWM的频率,校正发射端交流转换系统的输出频率达到发射端谐振电路的谐振频率,即进行谐振频率追踪; Secondly, when the circuit is working, the current sampling circuit at the transmitting end samples the current of the resonant circuit at the transmitting end, usually samples the current of the resonant circuit at the transmitting end, compares the value of the sampling current with the zero value, and changes the The frequency of the PWM sent by the digital signal processor DSP at the transmitting end corrects the output frequency of the AC conversion system at the transmitting end to reach the resonant frequency of the resonant circuit at the transmitting end, that is, traces the resonant frequency;
再者,接收端主电路在工作时,接收端的第二电压采样电路对水下机器人的电池电压进行采样,接收端电流采样电路对水下机器人电池的充电电流进行采样,采集的电压和电流信息送给接收端数字信号处理器DSP,在接收端数字信号处理器DSP中进行处理,从而根据处理结果,发出相应的PWM信号,控制接收端对水下机器人的充电模式,实现对水下机器人的电池能量管理。 Furthermore, when the main circuit at the receiving end is working, the second voltage sampling circuit at the receiving end samples the battery voltage of the underwater robot, and the current sampling circuit at the receiving end samples the charging current of the battery of the underwater robot, and the collected voltage and current information Send it to the digital signal processor DSP at the receiving end, and process it in the digital signal processor DSP at the receiving end, so that according to the processing result, a corresponding PWM signal is sent to control the charging mode of the underwater robot at the receiving end to realize the charging of the underwater robot. Battery energy management.
本发明与现有技术相比,其显著优点:(1)设计了水下的无线充电系统,实现水下机器人无接触充电。(2)利用电磁感应和负载检测电路的原理,实现了对接收端是否接入电路的检测,根据接收端接入与否适时的进入持续模式运行和检测模式运行,避免了过大的电流,提高了电路的安全性能。(3)通过对系统谐振频率进行追踪,使得发射端交流转换系统的输出电压频率与发射端谐振电路的谐振频率一致,提高了系统能量的传输效率。(4)通过水下机器人电池能量控制实现了对水下机器人充电功率的闭环控制,实现了水下机器人的恒功率充电,并通过电量实时对机器人的充电状态进行检测。 Compared with the prior art, the present invention has significant advantages: (1) An underwater wireless charging system is designed to realize contactless charging of underwater robots. (2) Using the principle of electromagnetic induction and load detection circuit, the detection of whether the receiving end is connected to the circuit is realized, and according to whether the receiving end is connected or not, it enters the continuous mode operation and the detection mode operation in a timely manner, avoiding excessive current, The safety performance of the circuit is improved. (3) By tracking the resonant frequency of the system, the output voltage frequency of the AC conversion system at the transmitting end is consistent with the resonant frequency of the resonant circuit at the transmitting end, which improves the energy transmission efficiency of the system. (4) The closed-loop control of the charging power of the underwater robot is realized through the battery energy control of the underwater robot, the constant power charging of the underwater robot is realized, and the charging state of the robot is detected in real time through the power.
下面结合附图对本发明作进一步详细描述。 The present invention will be described in further detail below in conjunction with the accompanying drawings.
附图说明 Description of drawings
图1为本发明的水下机器人无线充电系统主框架图(不包括水下机器人电池)。 Fig. 1 is a main frame diagram of the underwater robot wireless charging system of the present invention (not including the underwater robot battery).
图2为本发明主电路原理图。 Fig. 2 is a schematic diagram of the main circuit of the present invention.
图3为本发明中发射端控制电路原理图。 Fig. 3 is a schematic diagram of the control circuit of the transmitting end in the present invention.
图4为本发明中接收端控制电路原理图。 Fig. 4 is a schematic diagram of the receiving end control circuit in the present invention.
图5为本发明中水下机器人电池能量管理控制逻辑原理图。 Fig. 5 is a logic schematic diagram of the battery energy management control of the underwater robot in the present invention.
图6为本发明中负载检测流程图。 Fig. 6 is a flow chart of load detection in the present invention.
具体实施方式 detailed description
结合图1,本发明水下机器人无线充电系统,包括主电路和控制电路,所述主电路包括耦合连接的发射端主电路和接收端主电路,所述发射端主电路包括顺序连接的发射端直流电源系统、发射端交流转换系统以及发射端谐振电路,所述接收端主电路包括顺序连接的接收端谐振电路、接收端直流转换电路以及接收端负载匹配变换电路。 1, the underwater robot wireless charging system of the present invention includes a main circuit and a control circuit, the main circuit includes a coupling-connected transmitter main circuit and a receiver main circuit, and the transmitter main circuit includes sequentially connected transmitters A DC power supply system, an AC conversion system at the transmitting end, and a resonant circuit at the transmitting end. The main circuit at the receiving end includes a resonant circuit at the receiving end, a DC conversion circuit at the receiving end, and a load matching conversion circuit at the receiving end connected in sequence.
发射端交流转换系统将发射端直流电源系统输出的直流电转变(对电极点A、B间电压进行逆变,)为高频交流电,经发射端谐振电路将电能转换为场能发射,接收端谐振电路接收发射端发出的场能,并将接收到的场能转换为交流电能,经接收端直流转换电路变为直流电,经接收端负载匹配变换电路进行变换后输出对水下机器人电池充电,实现无线充电功能。 The AC conversion system at the transmitting end converts the DC output of the DC power supply system at the transmitting end (inverting the voltage between electrode points A and B) into high-frequency alternating current, and converts the electric energy into field energy through the resonant circuit at the transmitting end, and then resonates at the receiving end The circuit receives the field energy sent by the transmitter, and converts the received field energy into AC power, which is converted into DC by the DC conversion circuit at the receiver, converted by the load matching conversion circuit at the receiver, and then output to charge the battery of the underwater robot. Wireless charging function.
所述控制电路包括发射端控制电路和接收端控制电路,发射端控制电路包括分别连接在发射端数字信号处理器DSP上的发射端PWM驱动电路和发射端电流采样电路,该发射端电流采样电路连接在发射端谐振电路上;所述接收端控制电路包括分别连接在接收端数字信号处理器DSP上的接收端PWM驱动电路、接收端两路电压采样电路(由接收端第一电压采样电路、接收端第二电压采样电路组成)和接收端电流采样电路,所述接收端两路电压采样电路的接收端第一电压采样电路接在接收端直流转换电路的输出端,接收端第二电压采样电路串联连接在水下机器人电池正极和负极之间,所述接收端电流采样电路串联连接在水下机器人电池正极O与接收端负载匹配变换电路出书的正极P之间。数字信号处理电路可以是由dsPIC33FJ64GS606芯片及其外围供电电路组成。 The control circuit includes a transmitter control circuit and a receiver control circuit, the transmitter control circuit includes a transmitter PWM drive circuit and a transmitter current sampling circuit respectively connected to the transmitter digital signal processor DSP, the transmitter current sampling circuit Connected on the resonant circuit of the transmitting end; the receiving end control circuit comprises a receiving end PWM drive circuit connected respectively on the receiving end digital signal processor DSP, two voltage sampling circuits of the receiving end (by the first voltage sampling circuit of the receiving end, the first voltage sampling circuit of the receiving end, The second voltage sampling circuit at the receiving end is composed of) and the current sampling circuit at the receiving end, the first voltage sampling circuit at the receiving end of the two voltage sampling circuits at the receiving end is connected to the output end of the DC conversion circuit at the receiving end, and the second voltage sampling circuit at the receiving end The circuit is connected in series between the positive pole and the negative pole of the battery of the underwater robot, and the current sampling circuit at the receiving end is connected in series between the positive pole O of the battery of the underwater robot and the positive pole P of the load matching conversion circuit at the receiving end. The digital signal processing circuit can be composed of a dsPIC33FJ64GS606 chip and its peripheral power supply circuit.
结合图2和图3,本发明水下机器人无线充电系统的发射端交流转换系统包括第一功率MOS开关管S1、第二功率MOS开关管S2、第三功率MOS开关管S3、第四功率MOS开关管S4;第一功率MOS开关管S1的漏极、第三功率MOS开关管S3的漏极与发射端直流电源系统的正极A相连,第一功率MOS开关管S1的源极与第二功率MOS开关管S2的漏极相连,第三功率MOS开关管S3的源极与第四功率MOS开关管S4的漏极相连,第二功率MOS开关管S2的源极、第四功率MOS开关管S4的源极与发射端直流电源系统的负极B连接,第一功率MOS开关管S1的栅极接发射端PWM驱动电路的第一路PWM信号端,第二功率MOS开关管S2的栅极接发射端PWM驱动电路的第二路PWM信号端,第三功率MOS开关管S3的栅极接发射端PWM驱动电路的第三路PWM信号端,第四功率MOS开关管S4的栅极接发射端PWM驱动电路的第四路PWM信号端。发射端数字信号处理器DSP通过发射端PWM驱动电路控制所述发射端四个功率MOS开关管动作,接收端数字信号处理器DSP通过接收端PWM驱动电路控制接收端负载匹配电路内的一个功率MOS开关管动作。 2 and 3, the transmitter AC conversion system of the underwater robot wireless charging system of the present invention includes a first power MOS switch tube S1, a second power MOS switch tube S2, a third power MOS switch tube S3, and a fourth power MOS switch tube S3. Switch tube S4; the drain of the first power MOS switch tube S1 and the drain of the third power MOS switch tube S3 are connected to the positive pole A of the transmitting end DC power supply system, and the source of the first power MOS switch tube S1 is connected to the second power The drain of the MOS switch tube S2 is connected, the source of the third power MOS switch tube S3 is connected to the drain of the fourth power MOS switch tube S4, the source of the second power MOS switch tube S2, the fourth power MOS switch tube S4 The source of the transmitter is connected to the negative pole B of the DC power supply system at the transmitter, the gate of the first power MOS switch S1 is connected to the first PWM signal terminal of the PWM drive circuit at the transmitter, and the gate of the second power MOS switch S2 is connected to the transmitter The second PWM signal terminal of the terminal PWM drive circuit, the gate of the third power MOS switch S3 is connected to the third PWM signal terminal of the transmitter PWM drive circuit, and the gate of the fourth power MOS switch S4 is connected to the transmitter PWM The fourth PWM signal terminal of the drive circuit. The digital signal processor DSP at the transmitting end controls the action of the four power MOS switches at the transmitting end through the PWM driving circuit at the transmitting end, and the digital signal processor DSP at the receiving end controls a power MOS in the load matching circuit at the receiving end through the PWM driving circuit at the receiving end. Switch tube action.
结合图2和图3,本发明水下机器人无线充电系统的发射端谐振电路包括发射端谐振电容C1和发射端谐振电感L1,该发射端谐振电容C1的一端与第一功率MOS开关管S1的源极连接;发射端谐振电容C1的另一端与发射端谐振电感L1的一端连接;发射端谐振电感L1的另一端与第四功率MOS开关管S4的漏极连接。 2 and 3, the transmitter resonant circuit of the underwater robot wireless charging system of the present invention includes a transmitter resonant capacitor C1 and a transmitter resonant inductor L1, one end of the transmitter resonant capacitor C1 is connected to the first power MOS switch tube S1 The source is connected; the other end of the transmitter resonance capacitor C1 is connected to one terminal of the transmitter resonance inductor L1; the other end of the transmitter resonance inductor L1 is connected to the drain of the fourth power MOS switch S4.
结合图2和图4,本发明水下机器人无线充电系统的接收端直流转换电路包括第一二极管VD1、第二二极管VD2、第三二极管VD3、第四二极管VD4;第一二极管VD1的阴极、第三二极管VD3的阴极与第三电感L3的一端连接,第一二极管VD1的阳极与第二二极管VD2的阴极连接,第三二极管VD3的阳极与第四二极管VD4的阴极连接,第二二极管VD2的阳极与第四二极管VD4的阳极与第五功率MOS开光管S5的源极连接。接收端直流转换电路对接收端谐振电路的输出电压进行整流,端子M、N与接收端第一电压采样电路连接。 Referring to Fig. 2 and Fig. 4, the receiving end DC conversion circuit of the underwater robot wireless charging system of the present invention includes a first diode VD1, a second diode VD2, a third diode VD3, and a fourth diode VD4; The cathode of the first diode VD1 and the cathode of the third diode VD3 are connected to one end of the third inductor L3, the anode of the first diode VD1 is connected to the cathode of the second diode VD2, and the third diode The anode of VD3 is connected to the cathode of the fourth diode VD4, the anode of the second diode VD2 is connected to the anode of the fourth diode VD4 and the source of the fifth power MOS switch S5. The DC conversion circuit at the receiving end rectifies the output voltage of the resonant circuit at the receiving end, and the terminals M and N are connected to the first voltage sampling circuit at the receiving end.
结合图2和图4,本发明水下机器人无线充电系统的接收端谐振电路包括接收端谐振电容C2和接收端谐振电感L2,该接收端谐振电容C2的一端与第一二极管VD1的阳极连接,另一端与接收端谐振电感L2的一端连接,该接收端谐振电感L2的另一端与第四二极管VD4的阴极连接。水下机器人通过接收端谐振电感L2和谐振电容C2接受发射端谐振电路传输来的场能并转变为电能,经过接收端直流转换电路和接收端负载匹配电路后给水下机器人电池充电。 2 and 4, the receiving end resonant circuit of the underwater robot wireless charging system of the present invention includes a receiving end resonant capacitor C2 and a receiving end resonant inductance L2, and one end of the receiving end resonant capacitor C2 is connected to the anode of the first diode VD1 The other end is connected to one end of the resonant inductor L2 at the receiving end, and the other end of the resonant inductor L2 at the receiving end is connected to the cathode of the fourth diode VD4. The underwater robot receives the field energy transmitted by the resonant circuit at the transmitting end through the resonant inductor L2 and the resonant capacitor C2 at the receiving end and converts it into electrical energy, and charges the battery of the underwater robot after passing through the DC conversion circuit at the receiving end and the load matching circuit at the receiving end.
结合图2和图4,本发明水下机器人无线充电系统的接收端负载匹配电路包括第三电感L3、第五功率MOS开关管S5、第五二极管VD5以及第三电容C3,所述接收端直流转换电路输出的正极M与机器人电池接口正极P之间串接第三电感C3和第五二极管VD5,所述第五功率MOS开关管S5的漏极接第三电感C3和第五二极管VD5之间的电极点I,第五功率MOS开关管的源极接在接收端直流转换电路输出的负极N,第五功率MOS开关管的栅极接在接收端PWM驱动电路的第五PWM信号端,接收端负载匹配变换电路输出的正极P与负极Q之间串接第三电容C3。端子PQ与接收端第二电压采样电路连接,端子PQ两端电压、R点电流以及端子M、N两端电压用于实现机器人电池的能量管理,实现恒功率充电以及充电控制,接收端负载匹配电路对接收端直流转换电路MN端输出电压进行转换,使得输出电压等级满足机器人电池的电压等级,同时满足输入电压电流的持续性,输出经第三电容C3,得到的电压给机器人电池充电;发射端PWM驱动电路接收来自发射端数字信号处理器DSP传来的信号,驱动上述发射端第一到第四功率MOS开关管动作;接收端PWM驱动电路接收来自接收端数字信号处理器DSP传来的信号,驱动上述接收端第五功率MOS开关管动作。 2 and 4, the receiving end load matching circuit of the underwater robot wireless charging system of the present invention includes a third inductor L3, a fifth power MOS switch S5, a fifth diode VD5 and a third capacitor C3. A third inductance C3 and a fifth diode VD5 are connected in series between the positive pole M output by the terminal DC conversion circuit and the positive pole P of the robot battery interface, and the drain of the fifth power MOS switch tube S5 is connected to the third inductance C3 and the fifth diode VD5. At the electrode point I between the diodes VD5, the source of the fifth power MOS switch is connected to the negative pole N output by the DC conversion circuit at the receiving end, and the gate of the fifth power MOS switch is connected to the first electrode of the PWM drive circuit at the receiving end. Five PWM signal terminals, a third capacitor C3 is connected in series between the positive pole P and the negative pole Q output by the load matching conversion circuit at the receiving end. The terminal PQ is connected to the second voltage sampling circuit at the receiving end. The voltage across the terminal PQ, the current at point R, and the voltage across the terminals M and N are used to realize the energy management of the robot battery, realize constant power charging and charging control, and match the load at the receiving end. The circuit converts the output voltage of the MN terminal of the DC conversion circuit at the receiving end, so that the output voltage level meets the voltage level of the robot battery, and at the same time satisfies the continuity of the input voltage and current, and outputs the voltage obtained by the third capacitor C3 to charge the robot battery; The PWM driving circuit at the receiving end receives the signal from the digital signal processor DSP at the transmitting end, and drives the first to fourth power MOS switches at the transmitting end to act; the PWM driving circuit at the receiving end receives the signal from the digital signal processor DSP at the receiving end signal to drive the fifth power MOS switch at the receiving end to act.
结合图1至图5,本发明利用上述的水下机器人无线充电系统的控制方法,首先是检测模式和持续运行模式,检测发射端谐振电路的电流,通过发射端谐振电路的电流变化判定接收端是否接入电路,即负载检测,若发射端检测到接收端接入电路后,发射端数字信号处理器DSP发出充电指令,电路进入工作状态,通过发射端PWM驱动电路控制发射端交流转换系统输出交流电,经过发射端谐振电路将电能传输到接收端,接收端通过接收端谐振电路接收发射端传输来的能量,并把这些能量转变为交流电输出,经过接收端直流转换电路以及接收端负载匹配电路后,对水下机器人电池进行充电,若发射端检测到接收端离开电路或者接收端水下机器人电池电量充满后,发射端数字信号处理器DSP发出停止充电的指令,并将控制发射端主电路电路回归检测模式运行; 1 to 5, the present invention utilizes the above-mentioned control method of the wireless charging system for underwater robots, first of all, in the detection mode and the continuous operation mode, to detect the current of the resonant circuit at the transmitting end, and determine the current change of the resonant circuit at the transmitting end to determine the current of the receiving end. Whether it is connected to the circuit, that is, load detection, if the transmitter detects that the receiver is connected to the circuit, the digital signal processor DSP at the transmitter sends a charging command, the circuit enters a working state, and the output of the AC conversion system at the transmitter is controlled by the PWM drive circuit at the transmitter Alternating current, through the resonant circuit of the transmitting end, the electric energy is transmitted to the receiving end, and the receiving end receives the energy transmitted by the transmitting end through the resonant circuit of the receiving end, and converts these energy into AC output, and passes through the DC conversion circuit of the receiving end and the load matching circuit of the receiving end Finally, charge the battery of the underwater robot. If the transmitting end detects that the receiving end has left the circuit or the battery of the underwater robot at the receiving end is fully charged, the digital signal processor DSP at the transmitting end will issue a command to stop charging and will control the main circuit of the transmitting end. Circuit regression detection mode operation;
其次,在电路工作时发射端电流采样电路对发射端谐振电路的电流进行采样,通多对发射端谐振电路的电流进行采样,通过采样电流的值与零值相比较,通过比较的值,改变发射端数字信号处理器DSP发出的PWM的频率,校正发射端交流转换系统的输出频率达到发射端谐振电路的谐振频率,即进行谐振频率追踪; Secondly, when the circuit is working, the current sampling circuit at the transmitting end samples the current of the resonant circuit at the transmitting end, usually samples the current of the resonant circuit at the transmitting end, compares the value of the sampling current with the zero value, and changes the The frequency of the PWM sent by the digital signal processor DSP at the transmitting end corrects the output frequency of the AC conversion system at the transmitting end to reach the resonant frequency of the resonant circuit at the transmitting end, that is, traces the resonant frequency;
再者,接收端主电路在工作时,接收端的第二电压采样电路对水下机器人的电池电压进行采样,接收端电流采样电路对水下机器人电池的充电电流进行采样,采集的电压和电流信息送给接收端数字信号处理器DSP,在接收端数字信号处理器DSP中进行处理,从而根据处理结果,发出相应的PWM信号,控制接收端对水下机器人的充电模式,实现对水下机器人的电池能量管理。 Furthermore, when the main circuit at the receiving end is working, the second voltage sampling circuit at the receiving end samples the battery voltage of the underwater robot, and the current sampling circuit at the receiving end samples the charging current of the battery of the underwater robot, and the collected voltage and current information Send it to the digital signal processor DSP at the receiving end, and process it in the digital signal processor DSP at the receiving end, so that according to the processing result, a corresponding PWM signal is sent to control the charging mode of the underwater robot at the receiving end to realize the charging of the underwater robot. Battery energy management.
本发明水下机器人无线充电系统的控制方法中,负载检测的具体方法为:发射端主电路开始初始化时,发射端主电路处于检测模式运行,每1s运行20个周期,在每个PWM波的中点对发射端谐振电路中电感(即电极点F)上的电流进行采样,取中间的采样值,若此时的电流小于20安培,则发射端主电路转为持续模式运行,若此时电流值大于20安培,则继续检测模式运行,取中间的采样值,通过和前1秒所取的采样值相比较来决定电路的工作模式,由于接收端接入的时候,接收端的电感线圈会在发射端产生一个互感阻抗,使得发射端谐振电路电感中的电流产生2安培左右的幅值的减小。若电流采样值比前一秒采样值减小的幅值超过2安培,则证明接收端主电路接入电路,电路进入持续模式运行,电路持续工作,对水下机器人电池进行充电,在持续模式运行时,每个周期在PWM的中点处对发射端电感上的电流进行采样,每秒取一次中间值,同时,每秒进行一次比较,若检测的电流值增大幅度超过2安培,则发射端停止持续模式工作,转为检测模式运行若与前一秒的采样值相比,电流大小的变化在1安培之内,则证明接收端无动作,电路维持之前的模式运行。 In the control method of the underwater robot wireless charging system of the present invention, the specific method of load detection is: when the main circuit of the transmitting end starts to initialize, the main circuit of the transmitting end is in the detection mode and runs for 20 cycles every 1s. The middle point samples the current on the inductor (i.e. electrode point F) in the resonant circuit of the transmitting end, and takes the middle sampling value. If the current at this time is less than 20 amperes, the main circuit of the transmitting end will switch to continuous mode operation. If at this time If the current value is greater than 20 amperes, continue to run in the detection mode, take the middle sampling value, and compare it with the sampling value taken in the previous 1 second to determine the working mode of the circuit. When the receiving end is connected, the inductance coil at the receiving end will A mutual inductance impedance is generated at the transmitting end, so that the current in the inductance of the resonant circuit at the transmitting end produces a decrease in amplitude of about 2 amperes. If the current sampling value decreases by more than 2 amperes compared with the sampling value of the previous second, it proves that the main circuit of the receiving end is connected to the circuit, the circuit enters continuous mode operation, and the circuit continues to work to charge the battery of the underwater robot. During operation, the current on the transmitter inductor is sampled at the midpoint of the PWM every cycle, and the intermediate value is taken every second. At the same time, a comparison is made every second. If the detected current value increases by more than 2 amperes, then The transmitter stops working in the continuous mode and switches to the detection mode. If the current change is within 1 ampere compared with the sampling value of the previous second, it proves that the receiving end has no action, and the circuit maintains the previous mode operation.
在电路工作过程中,为了使电路始终处于最大功率和做大效率运行,节省了能源,还会进行谐振点追踪,在发射端电容与电感串联的发射端谐振电路中,通过比较发射端谐振电路中的电流和发射端交流转换系统输出电压之间的相位差,可以得出发射端电路是否处于谐振点工作。本发明水下机器人无线充电系统的控制方法中,谐振频率追踪的方法为:在每个PWM的上升沿对发射端谐振电路中电感上的电流进行采样,若采样值大于零,则证明发射端谐振电路中的电流超前发射端交流转换系统的输出电压,电路呈现容性,则调大发射端交流转换系统的输出电压的频率,直到电流的采样值为零;若采样值小于零,则证明发射端谐振电路中的电流滞后发射端交流转换系统的输出电压,电路呈现感性,则调小发射端交流转换系统的输出电压的频率,直到电流的采样值为零;若采样值等于零,则证明发射端谐振电路中的电流与发射端交流转换系统的输出电压同相位,电路处于谐振点运行,因此发射端交流转换系统的输出电压的频率不变。 During the working process of the circuit, in order to keep the circuit running at the maximum power and efficiency at all times, and save energy, the resonance point tracking will also be carried out. The phase difference between the current in the transmitter and the output voltage of the AC conversion system at the transmitter can be used to determine whether the transmitter circuit is working at the resonance point. In the control method of the underwater robot wireless charging system of the present invention, the method of resonant frequency tracking is: sampling the current on the inductor in the resonant circuit of the transmitting end at each rising edge of PWM, if the sampling value is greater than zero, it proves that the transmitting end The current in the resonant circuit is ahead of the output voltage of the AC conversion system at the transmitting end, and the circuit is capacitive, so increase the frequency of the output voltage of the AC conversion system at the transmitting end until the sampling value of the current is zero; if the sampling value is less than zero, it proves that The current in the resonant circuit at the transmitting end lags behind the output voltage of the AC conversion system at the transmitting end, and the circuit is inductive, so reduce the frequency of the output voltage of the AC conversion system at the transmitting end until the sampling value of the current is zero; if the sampling value is equal to zero, it proves that The current in the resonant circuit at the transmitting end is in the same phase as the output voltage of the AC conversion system at the transmitting end, and the circuit operates at the resonance point, so the frequency of the output voltage of the AC converting system at the transmitting end remains unchanged.
本发明的控制过程还进行了对电池的能量管理控制,系统中的功率匹配闭环电路实际上相当于一个模拟的可调负载,而由于接收端负载匹配电路的输出为水下机器人电池,电压为定值,因此本系统对接收端负载匹配电路的输入电压进行控制,控制对象为占空比对输入电压的传递函数,选取了零极相消的PI控制器对其进行输入电压控制,首先,对接收端负载匹配电路的输入电压即M点与N点之间的电压进行采样,与设定值比较,经过接收端数字信号处理器DSP进行PI运算,得出一个新的PWM占空比,输出给接收端负载匹配电路,从而控制接收端负载匹配电路的输入电压,通过对接收端负载匹配电路的输入电压控制,控制了模拟负载的值,从而控制了传输功率,同时对接收端负载匹配电路输出电压和输出电流进行采样,计算实时的输出功率,通过与给定值比较,经过接收端数字信号处理器DSP进行处理,改变PWM占空比,从而改变系统的输出功率,使其达到给定值,实现恒功率充电。即本发明水下机器人无线充电系统的控制方法中,水下机器人的电池能量管理方法为:在电池电量低于50%时,进行充电,在电池电流高于90%时,由负载匹配变换器结束充电,即在对水下机器人进行充电时,对电池的充电功率进行控制,实现恒功率充电,具体由双环闭环控制实现:对电池的电压以及充电电流进行采样,与给定的恒定功率进行比较,其误差通过数字信号处理器DSP进行积分处理生成功率匹配变换器输入电压的参考值;对功率匹配变换器进行输入电压的控制,从而控制输出功率即电池的充电功率达到给定的恒定功率,实现恒功率充电。如图5所示,为电池能量管理控制原理图,CP为功率控制器,LUT为电池电量监测控制器,CV为电压控制器,GV为利用小信号分析法得出的控制占空比到输出电压VMN的传递函数,HV为输出电压采样电路的传递函数,此控制系统旨在对电池电量的检测与管理,同时对电池充电功率的控制,实现恒功率充电,所述电池电量检测控制器LUT为查表指令,功率控制器Cp为功率计算指令,电压控制器CV,传递函数GV以及电压采样电路的传递函数HV其公式见表1(本发明中水下机器人电池能量管理控制逻辑原理图中部分控制器和控制对象的传递函数)。 The control process of the present invention has also carried out energy management control to the battery, and the power matching closed-loop circuit in the system is actually equivalent to a simulated adjustable load, and since the output of the load matching circuit at the receiving end is an underwater robot battery, the voltage is fixed value, so this system controls the input voltage of the load matching circuit at the receiving end, the control object is the transfer function of the duty ratio to the input voltage, and the PI controller with zero-pole cancellation is selected to control the input voltage. First, Sampling the input voltage of the load matching circuit at the receiving end, that is, the voltage between point M and point N, comparing it with the set value, and performing PI calculation through the digital signal processor DSP at the receiving end to obtain a new PWM duty cycle. Output to the load matching circuit at the receiving end to control the input voltage of the load matching circuit at the receiving end. By controlling the input voltage of the load matching circuit at the receiving end, the value of the analog load is controlled, thereby controlling the transmission power, and at the same time matching the load at the receiving end The output voltage and output current of the circuit are sampled, and the real-time output power is calculated. By comparing with the given value, it is processed by the digital signal processor DSP at the receiving end to change the PWM duty cycle, thereby changing the output power of the system to achieve the given value. Constant value to achieve constant power charging. That is, in the control method of the underwater robot wireless charging system of the present invention, the battery energy management method of the underwater robot is as follows: when the battery power is lower than 50%, charging is performed; when the battery current is higher than 90%, the load matching converter End charging, that is, when charging the underwater robot, control the charging power of the battery to realize constant power charging, which is specifically realized by double-loop closed-loop control: sampling the voltage and charging current of the battery, and performing a test with a given constant power For comparison, the error is integrally processed by the digital signal processor DSP to generate a reference value for the input voltage of the power matching converter; the input voltage of the power matching converter is controlled to control the output power, that is, the charging power of the battery to a given constant power , to achieve constant power charging. As shown in Figure 5, it is the schematic diagram of battery energy management control, C P is the power controller, LUT is the battery power monitoring controller, C V is the voltage controller, G V is the control duty obtained by using the small signal analysis method Ratio to the transfer function of the output voltage V MN , H V is the transfer function of the output voltage sampling circuit, this control system aims to detect and manage the battery power, and at the same time control the charging power of the battery to achieve constant power charging, the battery The power detection controller LUT is a look-up table instruction, the power controller Cp is a power calculation instruction, the voltage controller CV, the transfer function GV of the voltage sampling circuit and the transfer function HV of the voltage sampling circuit. Transfer functions of some controllers and control objects in the robot battery energy management control logic schematic diagram).
表1 Table 1
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510541749.1A CN105262154A (en) | 2015-08-28 | 2015-08-28 | Wireless charging system for underwater robot and control method of wireless charging system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510541749.1A CN105262154A (en) | 2015-08-28 | 2015-08-28 | Wireless charging system for underwater robot and control method of wireless charging system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN105262154A true CN105262154A (en) | 2016-01-20 |
Family
ID=55101708
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510541749.1A Pending CN105262154A (en) | 2015-08-28 | 2015-08-28 | Wireless charging system for underwater robot and control method of wireless charging system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105262154A (en) |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106410975A (en) * | 2016-08-31 | 2017-02-15 | 成都国蓉科技有限公司 | Underwater charging system |
| CN107154680A (en) * | 2017-05-27 | 2017-09-12 | 山东大学 | A kind of coupling coil charged applied to underwater wireless and core structure and system |
| CN107919731A (en) * | 2016-10-06 | 2018-04-17 | 富士施乐株式会社 | Underwater moving body |
| CN109787312A (en) * | 2019-01-29 | 2019-05-21 | 南京师范大学 | A high frequency constant power wireless charging module based on PWM wave |
| CN111016690A (en) * | 2018-10-09 | 2020-04-17 | 郑州宇通客车股份有限公司 | Wireless charging control method and device for electric automobile |
| CN111169298A (en) * | 2020-01-31 | 2020-05-19 | 武汉大学 | Tube launch UAV wireless power supply system |
| CN111806259A (en) * | 2020-05-26 | 2020-10-23 | 中国电力科学研究院有限公司 | Wireless charging system and charging protection method |
| WO2021017404A1 (en) * | 2019-07-29 | 2021-02-04 | 歌尔股份有限公司 | Receiving-end circuit of wireless charging and electronic device having wireless charging function |
| CN112583081A (en) * | 2020-12-22 | 2021-03-30 | 上海空间电源研究所 | Quick wireless charging circuit of battery |
| CN113937867A (en) * | 2021-10-28 | 2022-01-14 | 蓓伟机器人科技(上海)有限公司 | Underwater resonance wireless charging system, underwater operation equipment and wireless charging method |
| WO2022174493A1 (en) * | 2021-02-20 | 2022-08-25 | 广州菲亚兰德科技有限公司 | Charger searching method and apparatus for underwater cleaning device, and underwater cleaning device |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2014017271A1 (en) * | 2012-07-24 | 2014-01-30 | 株式会社Ihi | Contactless power-transmission device for enclosed space |
| CN104158301A (en) * | 2014-01-20 | 2014-11-19 | 中国海洋大学 | Underwater wireless charging method and apparatus based on magnetic resonance |
| CN104362768A (en) * | 2014-11-06 | 2015-02-18 | 杭州电子科技大学 | Multifunctional underwater inductive coupling charge system |
| CN104734300A (en) * | 2015-04-09 | 2015-06-24 | 扬州大学 | Electric vehicle wireless charging circuit and control method thereof |
-
2015
- 2015-08-28 CN CN201510541749.1A patent/CN105262154A/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2014017271A1 (en) * | 2012-07-24 | 2014-01-30 | 株式会社Ihi | Contactless power-transmission device for enclosed space |
| CN104158301A (en) * | 2014-01-20 | 2014-11-19 | 中国海洋大学 | Underwater wireless charging method and apparatus based on magnetic resonance |
| CN104362768A (en) * | 2014-11-06 | 2015-02-18 | 杭州电子科技大学 | Multifunctional underwater inductive coupling charge system |
| CN104734300A (en) * | 2015-04-09 | 2015-06-24 | 扬州大学 | Electric vehicle wireless charging circuit and control method thereof |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106410975A (en) * | 2016-08-31 | 2017-02-15 | 成都国蓉科技有限公司 | Underwater charging system |
| CN107919731A (en) * | 2016-10-06 | 2018-04-17 | 富士施乐株式会社 | Underwater moving body |
| CN107919731B (en) * | 2016-10-06 | 2023-05-02 | 富士胶片商业创新有限公司 | underwater mobile body |
| CN107154680A (en) * | 2017-05-27 | 2017-09-12 | 山东大学 | A kind of coupling coil charged applied to underwater wireless and core structure and system |
| CN111016690B (en) * | 2018-10-09 | 2021-08-17 | 郑州宇通客车股份有限公司 | Wireless charging control method and device for electric automobile |
| CN111016690A (en) * | 2018-10-09 | 2020-04-17 | 郑州宇通客车股份有限公司 | Wireless charging control method and device for electric automobile |
| CN109787312A (en) * | 2019-01-29 | 2019-05-21 | 南京师范大学 | A high frequency constant power wireless charging module based on PWM wave |
| WO2021017404A1 (en) * | 2019-07-29 | 2021-02-04 | 歌尔股份有限公司 | Receiving-end circuit of wireless charging and electronic device having wireless charging function |
| CN111169298A (en) * | 2020-01-31 | 2020-05-19 | 武汉大学 | Tube launch UAV wireless power supply system |
| CN111806259A (en) * | 2020-05-26 | 2020-10-23 | 中国电力科学研究院有限公司 | Wireless charging system and charging protection method |
| CN112583081A (en) * | 2020-12-22 | 2021-03-30 | 上海空间电源研究所 | Quick wireless charging circuit of battery |
| WO2022174493A1 (en) * | 2021-02-20 | 2022-08-25 | 广州菲亚兰德科技有限公司 | Charger searching method and apparatus for underwater cleaning device, and underwater cleaning device |
| CN113937867A (en) * | 2021-10-28 | 2022-01-14 | 蓓伟机器人科技(上海)有限公司 | Underwater resonance wireless charging system, underwater operation equipment and wireless charging method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105262154A (en) | Wireless charging system for underwater robot and control method of wireless charging system | |
| CN104734300B (en) | A kind of electric motor car wireless charging circuit and its control method | |
| CN103972995B (en) | Method for two-way wireless transmission of energy and information | |
| CN105634093A (en) | Movable three-dimensional wireless charging device of mobile phones | |
| CN104362769B (en) | A kind of wireless power transfer system | |
| CN108237943A (en) | A kind of dual output port charging circuit and its control method | |
| CN112219333B (en) | Wireless charging transmitting device, transmitting method and wireless charging system | |
| CN104485756A (en) | Electricity picking device for high-voltage power transmission line | |
| CN108879869B (en) | Primary-side control method and implementation system of wireless charging system based on load characteristics | |
| CN110492621A (en) | Constant voltage/constant current type wireless charging system based on transmitting terminal TS/FS structure changes compensation network | |
| US20210126544A1 (en) | Phase alignment circuit and method of receive end, and receive end | |
| CN111030266A (en) | Wireless charging system based on electromagnetic metamaterial and constant-current constant-voltage charging control method | |
| CN102074971B (en) | Feedback load energy-saving circuit for aging test and control method thereof | |
| CN110311476A (en) | Intelligent wireless charging device for mobile terminal and control method thereof | |
| CN112311107A (en) | Single-tube inversion inductive coupling electric energy transmission device and control method thereof | |
| CN103956803B (en) | A kind of wireless charging circuit of efficient electric automobile | |
| CN110611359A (en) | A device and method for realizing single-transistor inverter constant-current constant-voltage wireless charging through secondary-side compensation network switching | |
| CN117254603A (en) | Wireless power transmission system with constant-current and constant-voltage output characteristics | |
| CN109861566A (en) | A kind of circuit of synchronous rectification, synchronous rectification method and wireless charging device | |
| WO2023213057A1 (en) | Double-resonance wireless charging circuit and control method thereof | |
| CN205490225U (en) | Two -way ACDC circuit of high -frequency chopper isolated form | |
| CN103972996B (en) | The method of energy and information bidirectional wireless transmission | |
| CN201878014U (en) | A regenerative load energy-saving circuit for aging test | |
| CN110126648A (en) | The tracking of electric car wireless charging maximum current from optimizing tuning control method | |
| CN110112836A (en) | A kind of magnet coupled resonant type wireless transmission system and control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160120 |