Embodiment
The present invention is described in further detail below in conjunction with accompanying drawing.
See also shown in Figure 1, the present invention is a kind of supervising device that is applicable to interference optical fiber top, this supervising device is by first processor D4, the second processor D8, the level shifting circuit of first processor, the level shifting circuit of second processor, and first processor power control switch D9, gyro testing circuit power switch D10 and secondary light source power control switch D11 form, first processor D4 receives the serial data of gyro output, the PIN_1 signal, the PIN_2 signal, light source temperature control Fault0_1 signal, light source temperature control Fault1_1 signal, light source temperature control Fault0_2 signal, light source temperature control Fault1_2 signal, power supply 3V3_DP1 signal, the level shifting circuit of first processor receives the data message of first processor D4 output, the level shifting circuit of second processor receives the data message of second processor D8 output, and second processor D8 out-put supply control signal respectively gives gyro testing circuit power control switch D10 and secondary light source power control switch D11.
In the present invention, the level shifting circuit of first processor is made up of incoming level conversion chip D3 and transmission level conversion chip D2; The level shifting circuit of second processor is made up of incoming level conversion chip D6 and transmission level conversion chip D7.
In the present invention, first processor D4 chooses the TMS320LF240XA family chip, the second processor D8 chooses the TMS320LF240XA family chip, incoming level conversion chip in the level shifting circuit of the level shifting circuit of first processor and second processor is chosen the MAX3371 chip, the transmission level conversion chip is chosen the MAX3371 chip, first processor power control switch D9 chooses the TPS2024 chip, gyro testing circuit power switch D10 chooses the TPS2024 chip, and secondary light source power supply control transmission level conversion chip system switch D11 chooses the TPS2024 chip.
The present invention adopts the supervising device of two CPU redundancy backup designs, and first CPU is used to receive the parameter of interference optical fiber top output, output after packing; Second CPU is used to monitor the duty of interference optical fiber top, also the duty of first CPU monitored simultaneously, also can be used as the backup communication of first CPU.Such supervising device can be handled the various duties of three axis optical fibre gyro in real time, and carries out the processing of correlativity according to the fault of three axis optical fibre gyro definition, and has improved the reliability of supervising device.
The connection of each terminal is as follows in the hardware circuit of the present invention:
(1) each terminal connection of first processor D4 (TMS320LF2403A chip) is: shown in Fig. 2 A
The power input 6,10,27,35,52,56 of first processor D4, AD conversion power supply input end 21, phaselocked loop power supply input end 39 link to each other with the output terminal 6 of switch D9, AD changes high reference voltage end 20 and links to each other with the voltage output end 4 of Voltage Reference source chip C3, and FLASH programming power supply input end 60 connects+the 5V power supply;
The ground input end 5,9,26,51,55 of D4 connects digitally, and power drives interrupting input end 36 connects digitally, and AD converter power supply ground input end 22 connects simulation ground, and the low reference voltage input terminal 19 of AD converter connects simulation ground.
The end 7,8,29,30,31,32,33 of D4 connects the end 8,7,6,4,2,3,5 that JTAG downloads socket X3 respectively, the end 8 of JTAG download socket X3 connects the back and connects with the end 6 of switch D9 with resistance R 4, end 7 connects the back with resistance R 3 and connects with the end 6 of switch D9, end 1 connects with the end 6 of switch D9, holds 9 to connect digitally.
The AD conversion input end 17 of D4 connects with the end 1 of the pre-process circuit A2 of photodetector by resistance R 25, the end 8 of pre-process circuit A2 connects+connect simulation ground by capacitor C 47 behind the 5V power supply, end 4 connects-connect simulation ground by capacitor C 46 behind the 5V power supply, end 3 connects simulation ground by capacitor C 45, and connect gyro by resistance R 21, be connected in end 1 after resistance R 24 and capacitor C 48 are in parallel and hold between 2, end 2 connects simulation ground by resistance R 23, capacitor C 44, and connect with the end 7 of photoelectric commutator by resistance R 22, photoelectric commutator is a custom circuit; AD conversion input end 18 connects with the end 1 of the pre-process circuit A4 of photodetector by resistance R 30, the end 8 of pre-process circuit A4 connects+connect simulation ground by capacitor C 52 behind the 5V power supply, end 4 connects-connect simulation ground by capacitor C 51 behind the 5V power supply, end 3 connects simulation ground by capacitor C 50, and connect gyro by resistance R 26, be connected in end 1 after resistance R 29 and capacitor C 53 are in parallel and hold between 2, end 2 connects simulation ground by resistance R 28, capacitor C 49, and connects with the end 7 of photoelectric commutator by resistance R 27;
The startup ROM of D4 enables input end 23 and links to each other with the end 6 of switch D9 after resistance R 17;
The input end of clock 24 of D4 is connected with crystal oscillating circuit G1;
The reset signal input end 28 of D4 links to each other with the end 6 of switch D9 after resistance R 5, connects digitally after capacitor C 25;
Resistance R 19 is connected with capacitor C 35, and is connected between phase-locked loop clock filtering input end 38, the phase-locked loop clock filtering input end 37 with oscillatory circuit of capacitor C 35 formations in parallel;
The SPI sheet of D4 select output terminal 40, SPI master go out from go into end 45, SPI output terminal of clock 47 connects with circuit of light sources, Digital I input end 53,54 connects with circuit of light sources;
The Digital I output terminal 41 of D4 is imported 42 ends with the external interrupt of second CPU D8 and is connected after resistance R 6;
The serial data input end 44 of D4 links to each other with the end 6 of first cpu power gauge tap D9 after resistance R 7, and links to each other with the Z axle of optical fibre gyro;
The end 4 of level transferring chip D2 receives the CAN bus signals, through level conversion after hold 3 ends 63 of exporting to first processor D4; End 64 output signals of first processor D4 output signal to the CAN bus by holding 4 after end 3 level conversion of level transferring chip D3, end 63, end 64 have been realized the communication of first processor D4 and CAN bus;
Each terminal of (2) second processor D8 (TMS320LF2403A chip) connects: shown in Fig. 2 B
Power supply input end 6,10,27,35,52,56, the phaselocked loop power supply input end 39 of the second processor D8 connect digital 3.3V power supply; AD converter power supply input end 21 connects simulation 3.3V power supply; AD changes high reference voltage end 20 and links to each other with the voltage output end 4 of Voltage Reference source chip C4 (ADR391); FLASH programming power supply input end 60 connects+the 5V power supply.The ground input end 5,9,26,34,51,55 of D8 connects digitally, and power drives interrupting input end 36 connects digitally, and AD conversion power supply ground input end 22 connects simulation ground, and the low reference voltage end 19 of AD conversion connects simulation ground.
The end 7,8,29,30,31,32,33 of D8 is received 8,7,6,4,2,3,5 ends that JTAG downloads socket X4 respectively, the end 8 that JTAG downloads socket X4 meets digital 3.3V by resistance R 12, end 7 meets digital 3.3V by resistance R 11, and end 1 meets digital 3.3V, and end 9 connects digitally.
The end 2 of D8 connects with the end 4 of switch D 10, and passes through resistance R 15 and digitally connect; End 3 connects with the end 4 of switch D11, and passes through resistance R 16 and digitally connect; End 4 connects with the end 4 of switch D9, and passes through resistance R 14 and digitally connect;
The AD conversion input end 17 of D8 connects with the end 1 of the pre-process circuit A2 of photodetector, and AD conversion input end 18 connects with the end 1 of the pre-process circuit A4 of photodetector;
The startup ROM of D8 enables input end 23 and connects digital 3.3V power supply by resistance R 18;
The input end of clock 24 of D8 is connected with crystal oscillating circuit G2;
The reset signal input end 28 of D8 connects digital 3.3V power supply by resistance R 13, and connects digitally by capacitor C 27;
Resistance R 20 is connected with capacitor C 36, and is connected between phase-locked loop clock filtering input end 38, the phase-locked loop clock filtering input end 37 with oscillatory circuit of capacitor C 37 formations in parallel;
The SPI sheet of D8 select output terminal 40, SPI master go out from go into end 45, SPI output terminal of clock 47 connects with circuit of light sources,
The serial data input end 44 of D8 meets digital 3.3V by resistance R 10, and links to each other with the X-axis of optical fibre gyro;
The digital input end 53,54 of D8 connects with circuit of light sources respectively;
The end 4 of level transferring chip D7 receives the CAN bus signals, through level conversion after hold 3 ends 63 of exporting to the second processor D8; End 64 output signals of the second processor D8 output signal to the CAN bus by holding 4 after end 3 level conversion of level transferring chip D6, end 63, end 64 have been realized the communication of the second processor D8 and CAN bus.
(3) power supply:
In the present invention, power supply circuit is a custom circuit, its provide 3.3V ,+the 5V power supply is to first CPU, second CPU and each external circuit, provide-the 5V power supply is to the PIN signal pre-processing circuit.
(4) connection of each external circuit is:
The end 1 of reference voltage chip C3 (ADR391 chip) is in parallel with end 2, and links to each other with the end 6 of first cpu power gauge tap D9, and end 3 is in parallel after capacitor C 1 connects simulation ground with end 4, and end 5 connects simulation ground; The end 1 of first cpu power gauge tap chip D9 connects digitally, and end 2 meets digital 3.3V with end 3 after in parallel, end 6, end 7, holds 8 parallel connections, shown in Fig. 3 A;
The end 1 of reference voltage chip C4 (ADR391 chip) is in parallel with end 2, and links to each other with digital 3.3V by inductance L 5, and links to each other with simulation ground through capacitor C 29, capacitor C 30, capacitor C 31, and end 3 is in parallel after capacitor C 33 connects simulation ground with end 4;
The end 1 of gyro testing circuit power supply 3.3V gauge tap chip D10 connects digitally, and end 2 meets digital 3.3V with end 3 after in parallel, is connected with optical fibre gyro after end 6, end 7, end 8 are in parallel, shown in Fig. 3 B;
The end 1 of secondary light source power control switch chip D11 connects digitally, and end 2 meets digital 3.3V with end 3 after in parallel, connects with circuit of light sources after end 6, end 7, end 8 are in parallel, shown in Fig. 3 C.
The end 1 of photoelectric switching circuit A1 connects-5V, connects simulation ground by capacitor C 40, capacitor C 41, and end 3, end 5, end 8 connect simulation ground, end 4 connects-5V, end 7 output photoelectric conversion signals, end 10 connects+5V, connects simulation ground (shown in Fig. 4 A) by capacitor C 42, capacitor C 43.
The end 8 of the first photo detector signal pre-process circuit A2 connects+5V, connect simulation ground by capacitor C 47, end 4 connects-5V, connect simulation ground by capacitor C 46, end 3 connects the voltage-regulation end through resistance R 21, and by capacitor C 45 with connecing simulation, end 2 connects after resistance R 24 and capacitor C 48 are in parallel and holds 1, end 2 connects photoelectric conversion signal through resistance R 23, resistance R 22, connect simulation ground through capacitor C 44 between resistance R 23 and the resistance R 22, end 1 connects (shown in Fig. 4 B) through resistance R 25 with the end 17 of first processor D4, the end 17 of the second processor D8.
The end 8 of the second photo detector signal pre-process circuit A4 connects+5V, connect simulation ground by capacitor C 52, end 4 connects-5V, connect simulation ground by capacitor C 51, end 3 connects the voltage-regulation end through resistance R 26, and by capacitor C 50 with connecing simulation, end 2 connects after resistance R 29 and capacitor C 53 are in parallel and holds 1, end 2 connects photoelectric conversion signal through resistance R 28, resistance R 27, connect simulation ground through capacitor C 49 between resistance R 28 and the resistance R 27, end 1 connects (shown in Fig. 4 C) through resistance R 30 with the end 18 of first processor D4, the end 18 of the second processor D8.
In the present invention, the control flow of first processor D4 is:
1. the initialization of first processor (dsp chip): various registers, data storage area, program parameter in the first processor chip are carried out initial configuration;
2. three gyro main light source constant-current drive circuit parts (through end 40,45,47) are configured;
3. initialization finishes, receive the serial data (content includes gyro angular velocity X-axis information 32bits, Y-axis information 32bits, Z axis information 32bits, gyro internal temperature information 12bits) that optical fibre gyro sends over interrupt mode, after receiving, data are kept at gyro angular velocity storage unit, temperature storage unit in the DSP data storage area respectively;
4. start the A/D collector that carries on the first processor chip, A/D converted contents 10bits is kept at PIN value storage unit in the first processor data storage area;
5. gyro temperature control circuit duty 2bits is gathered and is kept in the temperature control state storage unit in the first processor chip data memory block;
6. the amplitude packing data that gyro angular velocity data, temperature data, PIN (photodetector) are located is sent;
Dsp chip that adopts among the present invention and fpga chip difference are: dsp chip is that serial is carried out to program implementation, and fpga chip is an executed in parallel to program implementation.Therefore, dsp chip can not be to fpga chip parallel like that reception and process information and data.
In the present invention, the control flow of the second processor D8 is:
1. the internal initialization of the second processor D8 (dsp chip): various registers, data storage area, program parameter in the dsp chip are carried out initial configuration;
2.DSP chip initiation finishes, receive the serial data (content includes gyro angular velocity X-axis information 32bits, Y-axis information 32bits, Z axis information 32bits, gyro internal temperature information 12bits) that optical fibre gyro sends over interrupt mode, after receiving, data are kept at gyro angular velocity storage unit, temperature storage unit in the DSP data storage area respectively;
3. the A/D collector that carries on the startup dsp chip is kept at PIN value storage unit in the dsp chip data storage area to A/D converted contents 10bits; (the PIN signal can not directly be connected on the A/D, needs through pre-process circuit)
4. gyro temperature control circuit duty 2bits is gathered and is kept in the temperature control state storage unit in the dsp chip data storage area; Begin information is analyzed and handled, its serial Interrupt Process content is following:
5. the amplitude packing data at gyro angular velocity data, temperature data, PIN place is sent (its condition that need satisfy of this step is the power supply that first processor D4 could move and disconnect first processor D4 when not working);
6. the gyro data of the current three gyro information that receives and front 5 times (determine times of collection by system, generally be made as 5~15 times) is compared, if the data no change is then restarted gyro testing circuit 3.3V power supply;
7. the PIN data and the PIN threshold value in the DSP program that A/D are collected compare (PIN threshold value lower limit FH, upper limit 199H), if data not in normal range, are then revised light source continuous current size, by changing source device output optical power, adjust the amplitude of PIN output signal;
8. the temperature threshold in gyro internal temperature information and the DSP program is compared (temperature threshold lower limit 000H, upper limit 5A0H), if the gyro temperature over-range, then turn-off gyro 3.3V and supply power to Millisecond and restart power supply after the time;
9. if gyro light source temperature control circuit working state abnormal (when two signals of Fault0_1 and Fault1_1 are not high level) is then restarted circuit of light sources power supply 3.3V; If turn-offed the power supply of first processor, then the dsp chip executive routine goes to step 2;
Second processor is being carried out the external interrupt processing: (step below just can entering into when having only when first processor D4 operation irregularity)
10. if first processor D4 operation irregularity then enters in the external interrupt program of the second processor D8, turn-off the 3.3V power supply of first processor D4, restart then, in the return message acquisition step 2; If first processor D4 operation irregularity repeats, then turn-off the 3.3V power supply of first processor D4 fully, enter into step 2;
In the present invention, the first processor D4 external interrupt that happens suddenly adopts the light source constant-current drive circuit is reinitialized configuration, and the system program of the second processor D8 goes to information acquisition step 2.
In the present invention, defined the fault of three axis optical fibre gyro system, as following table:
Fault |
Treating method |
Gyro temperature anomaly (the gyro temperature surpasses threshold value) |
Turn-off gyro and open the gyro power supply after power supply a period of time again |
PIN place abnormal signal (not in range of normal value) |
Light source power is revised |
Gyro temperature control circuit operation irregularity |
Restart the light source temperature control circuit |
The gyro output data is constant |
Restart the gyro resolving circuit and refer to conventional testing circuit |
Communication failure: refer to supervising device faults itself first processor operation irregularity |
Cut off first processor (host CPU) power supply, start second processor (aiding CPU) communication function |