CN109631885B - Navigation method based on dual-port RAM - Google Patents

Navigation method based on dual-port RAM Download PDF

Info

Publication number
CN109631885B
CN109631885B CN201811607348.1A CN201811607348A CN109631885B CN 109631885 B CN109631885 B CN 109631885B CN 201811607348 A CN201811607348 A CN 201811607348A CN 109631885 B CN109631885 B CN 109631885B
Authority
CN
China
Prior art keywords
control unit
dsp
port ram
dual
main control
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.)
Active
Application number
CN201811607348.1A
Other languages
Chinese (zh)
Other versions
CN109631885A (en
Inventor
王晴
黄朝丽
肖永平
陈涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shaanxi Aerospace Times Navigation Equipment Co ltd
Original Assignee
Shaanxi Aerospace Times Navigation Equipment Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shaanxi Aerospace Times Navigation Equipment Co ltd filed Critical Shaanxi Aerospace Times Navigation Equipment Co ltd
Priority to CN201811607348.1A priority Critical patent/CN109631885B/en
Publication of CN109631885A publication Critical patent/CN109631885A/en
Application granted granted Critical
Publication of CN109631885B publication Critical patent/CN109631885B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Arrangements For Transmission Of Measured Signals (AREA)

Abstract

The navigation method based on the dual-port RAM comprises an MEMS sensor, a GNSS receiving device, a DSP main control unit, a first RS232 output interface, a dual-port RAM chip, a DSP slave control unit, a second RS232 output interface and a secondary power module, wherein the DSP main control unit is used for collecting data and compensating the data, the DSP slave control unit is used for carrying out navigation resolving on the data, the interface and internal resources are utilized to the maximum extent, the dual-port RAM chip is used for carrying out data sharing, the data transmission speed is high, the instantaneity is high, and the system output meets the technical index requirements after the system full-temperature calibration, error parameter compensation and precision verification, has good stability and dynamic response characteristics, reduces the types of components and improves the system integration level.

Description

Navigation method based on dual-port RAM
Technical Field
The invention relates to the technical field of inertial navigation systems, in particular to a navigation method based on a dual-port RAM.
Background
The navigation computer system based on the dual-port RAM is used as a central brain of the navigation system, the operation efficiency and the instantaneity of the navigation computer system directly influence the control of the whole combined navigation system, the traditional navigation computer system is designed by adopting an FPGA+DSP working mode, the FPGA is used for data acquisition and simulating an external interface, the DSP is used for navigation calculation and data fusion, the data transmission between the two is carried out through an XINTF interface, two controllers cannot access a memory at the same time, the instantaneity of the system is influenced, and the FPGA software interface is complex in design and large in development workload.
Disclosure of Invention
In order to solve the defects in the prior art, the invention provides a navigation method based on a dual-port RAM.
The technical scheme of the invention is as follows: the navigation method based on the dual-port RAM comprises an MEMS sensor, a GNSS receiving device, a DSP main control unit, a first RS232 output interface, a dual-port RAM chip, a DSP slave control unit, a second RS232 output interface and a secondary power module, wherein the MEMS sensor and the GNSS receiving device are connected with the DSP main control unit which is used for collecting circuit signals of the MEMS sensor and receiving GPS/BD signals of the GNSS receiving device, the DSP main control unit is connected with the dual-port RAM chip which is used for reading data information of the DSP main control unit and the DSP slave control unit, the DSP main control unit is connected with the first RS232 output interface, the dual-port RAM chip is connected with the DSP slave control unit which is used for carrying out navigation calculation on the data information, and the secondary power module is used for respectively supplying power to the MEMS sensor, the GNSS receiving device, the DSP main control unit, the dual-port RAM chip and the DSP slave control unit, and the navigation method comprises the following steps:
the method comprises the steps that whether a circuit signal is acquired by an MEMS sensor is judged at fixed time, if the fixed time is up, the circuit signal of the MEMS sensor is acquired by a DSP main control unit through an SPI interface to perform temperature compensation, whether a GPS/BD signal exists in a GNSS receiving device is judged, if the GPS/BD signal of the GNSS receiving device is received by the DSP main control unit through an RS232 interface, data information and the GPS/BD signal of the DSP main control unit are read by a dual-port RAM chip and stored in a contracted address unit, an interrupt signal is generated by the right port of the dual-port RAM chip when writing operation is performed on the right port of the dual-port RAM chip, the DSP responds to the data information read after the interrupt from the control unit, writing operation is performed on the right port of the dual-port RAM chip to clear the interrupt, and initial alignment, navigation calculation and data fusion are performed by the DSP from the control unit; the DSP stores navigation data into a double-port RAM chip appointed address unit from a control unit, the left port generates an interrupt signal when writing operation is carried out on the left port, the DSP main control unit responds to the navigation data of the appointed address unit after the interrupt, the double-port RAM chip carries out writing operation on the left port of the double-port RAM chip and is used for clearing the interrupt, the double-port RAM chip reads navigation result data information of the DSP slave control unit and shares the navigation result data information to the DSP main control unit, and the DSP main control unit outputs navigation result data through a first RS232 output interface after reading the data information.
Preferably, the DSP is connected to the second RS232 output interface from the control unit, and the DSP outputs the navigation result data from the control unit through the second RS232 output interface.
The invention has the beneficial effects that: the DSP main control unit is used for collecting data and compensating and the DSP slave control unit is used for carrying out navigation calculation on the data, interfaces and internal resources are utilized to the maximum extent, the data sharing is carried out through the double-port RAM chip, the data transmission speed is high, the real-time performance is high, and after the system full-temperature calibration, error parameter compensation and precision verification, the system output meets the technical index requirements, has good stability and dynamic response characteristics, reduces the types of components and improves the system integration level.
Drawings
FIG. 1 is a schematic diagram of the functional module of the present invention;
FIG. 2 is a schematic diagram of the connection of a DSP master control unit, a dual port RAM and a DSP slave control unit;
FIG. 3 is a logic diagram of the DSP master control unit of the invention for collecting sensor information and outputting navigation results;
FIG. 4 is a logic diagram of the data fusion of the system DSP navigation solution from the control unit.
Detailed Description
In order to make the technical problems, technical solutions and advantages to be solved more apparent, the following detailed description will be given with reference to the accompanying drawings and specific embodiments.
The technical scheme of the invention is as follows: a navigation method based on dual-port RAM, as shown in figure 1, comprises a MEMS sensor, a GNSS receiving device, a DSP main control unit, a first RS232 output interface, a dual-port RAM chip, a DSP slave control unit, a second RS232 output interface and a secondary power module, as shown in figure 2, the MEMS sensor and the GNSS receiving device are connected with the DSP main control unit for collecting circuit signals of the MEMS sensor and receiving GPS/BD signals of the GNSS receiving device, the DSP main control unit is connected with the dual-port RAM chip for reading data information of the DSP main control unit and the DSP slave control unit, the dual-port RAM adopts 64k multiplied by 18 bit low-power consumption CMOS type static dual-port CY7C038 developed by Cypress company, the maximum access time is 20ms, the DSP main control unit is connected with the first RS232 output interface, the dual-port RAM chip is connected with the DSP slave control unit for carrying out navigation calculation on data information, +12V direct current power supply is input, after filtering, +5V is output through secondary power supply conversion, 3.3V and 1.9V power supplies are generated after internal power supply conversion to respectively supply power to the MEMS sensor and the GNSS receiving device, and the 3.0V power supply is used for supplying power to the DSP main control unit, the dual-port RAM and the DSP slave control unit, so that the navigation method is realized, and the method comprises the following steps:
as shown in fig. 3, the timing judgment is performed to determine whether the MEMS sensor collects the circuit signal, if the timing time is up, the DSP main control unit collects the circuit signal of the MEMS sensor through the SPI interface to perform temperature compensation, and determines whether the GNSS receiving apparatus has the GPS/BD signal, if the DSP main control unit receives the GPS/BD signal of the GNSS receiving apparatus through the RS232 interface, as shown in fig. 4, the dual-port RAM chip reads the data information and the GPS/BD signal of the DSP main control unit and stores them in the agreed address unit, while writing operation is performed to the right port of the dual-port RAM chip, the right port of the dual-port RAM chip generates an interrupt signal, the DSP responds to the interrupt from the control unit and reads the data information, and performs writing operation to the right port of the dual-port RAM chip to clear the interrupt, and the DSP performs initial alignment, navigation calculation and data fusion from the control unit; the DSP stores navigation data into a double-port RAM chip appointed address unit from a control unit, the left port generates an interrupt signal when writing operation is carried out on the left port, the DSP main control unit responds to the navigation data of the appointed address unit after the interrupt, the double-port RAM chip carries out writing operation on the left port of the double-port RAM chip and is used for clearing the interrupt, the double-port RAM chip reads navigation result data information of the DSP slave control unit and shares the navigation result data information to the DSP main control unit, and the DSP main control unit outputs navigation result data through a first RS232 output interface after reading the data information; the DSP is connected with the second RS232 output interface from the control unit, the DSP outputs navigation result data from the control unit through the second RS232 output interface, the second RS232 output interface is used for program debugging, the navigation result is checked, and the system can be used as an external interface redundancy design of the system.
Example 1: the DSP main control unit collects data information of angular velocity, acceleration, magnetic force, air pressure and temperature of the MEMS sensor and receives GPS/BD circuit signals of the GNSS receiving device, the DSP main control unit performs temperature compensation on the data information collected on the MEMS sensor through a compensation algorithm, then the data information and the GPS/BD circuit signals are shared to the dual-port RAM, the dual-port RAM reads the data information of the DSP main control unit and the GPS/BD signals and stores the data information and the GPS/BD signals in a contracted address unit, when writing operation is performed on the right port of the dual-port RAM, an interrupt signal is generated on the right port of the dual-port RAM, the DSP responds to the interrupt from the control unit, then reads the data information, then writing operation is performed on the right port of the dual-port RAM, the DSP performs initial alignment, navigation calculation and data fusion on the right port of the dual-port RAM, then the DSP main control unit stores navigation data into the contracted address unit, and simultaneously generates an interrupt signal on the left port when writing operation is performed on the left port, the DSP main control unit responds to the navigation data of the contracted address unit, then the left port RAM reads the navigation data of the dual-port RAM, and the DSP main control unit reads the navigation data from the data sharing result from the control unit, and outputs the data from the data sharing unit to the RS.
Example 2: the DSP main control unit collects data information of angular velocity, acceleration, magnetic force, air pressure and temperature of the MEMS sensor and receives GPS/BD circuit signals of the GNSS receiving device, the DSP main control unit performs temperature compensation on the data information collected on the MEMS sensor through a compensation algorithm, the data information and the GPS/BD circuit signals are shared to the dual-port RAM, the dual-port RAM reads the data information of the DSP main control unit and the GPS/BD signals and stores the data information and the GPS/BD signals in a contracted address unit, the dual-port RAM right port generates an interrupt signal when writing operation is performed on the dual-port RAM right port, the DSP responds to the interrupt signal from the control unit and reads the data information, then writing operation is performed on the dual-port RAM right port for clearing the interrupt signal, the DSP slave control unit performs initial alignment, navigation calculation and data fusion, and the DSP slave control unit outputs navigation result data information through a second RS232 output interface.
In order to avoid data read-write errors caused by address data contention when two DSPs access the same address unit, two modes of busy logic (hardware arbitration) and interrupt logic (interrupt arbitration) are comprehensively considered:
(1) Hardware arbitration mode
The dual-port RAM is provided with hardware arbitration logic (namely BUSY control) for solving the problem that two processors access the same address unit simultaneously, and when DSPs at two ends do not access the same address unit of the dual-port RAM, BUSYL= H, BUSYR =H can be normally stored; when the DSPs at two ends access the same address unit of the dual-port RAM, after the request access signal of which port appears, the corresponding BUSY=L prohibits the access of the data; when the sequence of the access request signals of the two ports cannot be judged, only one of the control lines BUSYL and BUSYR is low, normal access of the port corresponding to BUSY=H can be ensured, and the port corresponding to BUSY=L cannot be accessed, so that the possibility of errors caused by simultaneous competition of address resources by the DSP main control unit and the DSP slave control unit is avoided.
(2) Interrupt arbitration mode
The dual-port RAM is provided with two sets of independent interrupt logic, and is respectively connected to interrupt pins of the DSP main control unit and the DSP slave control unit through two INT pins so as to realize the handshake of the DSP main control unit and the DSP slave control unit.
The above embodiments are only preferred embodiments of the present invention and are not intended to limit the scope of the present invention, so that all equivalent modifications made by the appended claims shall be included in the scope of the present invention.

Claims (1)

1. A navigation method based on a dual-port RAM is characterized in that: the navigation system comprises a MEMS sensor, a GNSS receiving device, a DSP main control unit, a first RS232 output interface, a dual-port RAM chip, a DSP slave control unit, a second RS232 output interface and a secondary power module, wherein the MEMS sensor and the GNSS receiving device are connected with the DSP main control unit which is used for collecting circuit signals of the MEMS sensor and receiving GPS/BD signals of the GNSS receiving device, the DSP main control unit is connected with the dual-port RAM chip which is used for reading data information of the DSP main control unit and the DSP slave control unit, the DSP main control unit is connected with the first RS232 output interface, the dual-port RAM chip is connected with the DSP slave control unit which is used for carrying out navigation calculation on the data information, and the secondary power module is used for supplying power to the MEMS sensor, the GNSS receiving device, the DSP main control unit, the dual-port RAM chip and the DSP slave control unit respectively, and the navigation method comprises the following steps:
the method comprises the steps that whether a circuit signal is acquired by an MEMS sensor is judged at fixed time, if the fixed time is up, the circuit signal of the MEMS sensor is acquired by a DSP main control unit through an SPI interface to perform temperature compensation, whether a GPS/BD signal exists in a GNSS receiving device is judged, if the GPS/BD signal of the GNSS receiving device is received by the DSP main control unit through an RS232 interface, data information and the GPS/BD signal of the DSP main control unit are read by a dual-port RAM chip and stored in a contracted address unit, an interrupt signal is generated by the right port of the dual-port RAM chip when writing operation is performed on the right port of the dual-port RAM chip, the DSP responds to the data information read after the interrupt from the control unit, writing operation is performed on the right port of the dual-port RAM chip to clear the interrupt, and initial alignment, navigation calculation and data fusion are performed by the DSP from the control unit; the DSP stores navigation data into a double-port RAM chip appointed address unit from a control unit, the left port generates an interrupt signal when writing operation is carried out on the left port, the DSP main control unit responds to the navigation data of the appointed address unit after the interrupt, the double-port RAM chip carries out writing operation on the left port of the double-port RAM chip and is used for clearing the interrupt, the double-port RAM chip reads navigation result data information of the DSP slave control unit and shares the navigation result data information to the DSP main control unit, and the DSP main control unit outputs navigation result data through a first RS232 output interface after reading the data information;
the DSP slave control unit is connected with the second RS232 output interface, and the DSP slave control unit outputs navigation result data information through the second RS232 output interface.
CN201811607348.1A 2018-12-27 2018-12-27 Navigation method based on dual-port RAM Active CN109631885B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811607348.1A CN109631885B (en) 2018-12-27 2018-12-27 Navigation method based on dual-port RAM

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811607348.1A CN109631885B (en) 2018-12-27 2018-12-27 Navigation method based on dual-port RAM

Publications (2)

Publication Number Publication Date
CN109631885A CN109631885A (en) 2019-04-16
CN109631885B true CN109631885B (en) 2024-03-19

Family

ID=66078235

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811607348.1A Active CN109631885B (en) 2018-12-27 2018-12-27 Navigation method based on dual-port RAM

Country Status (1)

Country Link
CN (1) CN109631885B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110704344B (en) * 2019-09-25 2022-10-28 天津津航计算技术研究所 Double-path navigation communication method of embedded system

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1945211A (en) * 2006-10-24 2007-04-11 北京航空航天大学 Integrated combined navigation computer based on double DSP
CN105241453A (en) * 2015-10-18 2016-01-13 上海圣尧智能科技有限公司 Unmanned aerial vehicle navigation system and unmanned aerial vehicle
CN206248098U (en) * 2016-10-28 2017-06-13 陕西航天时代导航设备有限公司 Gyro phase shift test device in the used groups of MEMS
CN107202577A (en) * 2017-06-08 2017-09-26 南京理工大学 A kind of micro- PNT systems based on GNSS, chip atomic clock and micro- inertial navigation
CN107525506A (en) * 2017-09-29 2017-12-29 利辛县雨若信息科技有限公司 A kind of automobile connection journey navigation system based on guiding combination pattern
CN107907900A (en) * 2017-11-07 2018-04-13 长光卫星技术有限公司 A kind of multi-sensor combined navigation system and method for GNSS double antennas auxiliary
CN108535755A (en) * 2018-01-17 2018-09-14 南昌大学 The vehicle-mounted combined in real time air navigation aids of GNSS/IMU based on MEMS

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1945211A (en) * 2006-10-24 2007-04-11 北京航空航天大学 Integrated combined navigation computer based on double DSP
CN105241453A (en) * 2015-10-18 2016-01-13 上海圣尧智能科技有限公司 Unmanned aerial vehicle navigation system and unmanned aerial vehicle
CN206248098U (en) * 2016-10-28 2017-06-13 陕西航天时代导航设备有限公司 Gyro phase shift test device in the used groups of MEMS
CN107202577A (en) * 2017-06-08 2017-09-26 南京理工大学 A kind of micro- PNT systems based on GNSS, chip atomic clock and micro- inertial navigation
CN107525506A (en) * 2017-09-29 2017-12-29 利辛县雨若信息科技有限公司 A kind of automobile connection journey navigation system based on guiding combination pattern
CN107907900A (en) * 2017-11-07 2018-04-13 长光卫星技术有限公司 A kind of multi-sensor combined navigation system and method for GNSS double antennas auxiliary
CN108535755A (en) * 2018-01-17 2018-09-14 南昌大学 The vehicle-mounted combined in real time air navigation aids of GNSS/IMU based on MEMS

Also Published As

Publication number Publication date
CN109631885A (en) 2019-04-16

Similar Documents

Publication Publication Date Title
CN106649166A (en) Universal inertial data processing system based on uniform interface
CN108228513B (en) Intelligent serial port communication device based on FPGA framework
CN103810074A (en) System-on-chip and corresponding monitoring method
CN112596417A (en) Automatic driving operation domain controller and control system
CN104899167A (en) Portable high-speed data acquisition method based on FPGA
CN201665226U (en) Train control center main processing equipment
CN103593271A (en) Method and device for chip tracking debugging of system on chip
CN109931932A (en) A kind of high-precise synchronization integrated navigation computer
CN102636987B (en) Dual control device
CN100585568C (en) AHB bus test method and system
CN109631885B (en) Navigation method based on dual-port RAM
CN114490036A (en) Extensible distributed redundancy unmanned aerial vehicle intelligent flight control computer
CN101482836A (en) Method and apparatus to improve the effectiveness of system logging
KR20060004946A (en) Diagnostic data capture within an integrated circuit
CN104123246A (en) Interface expansion device and serial attached SCSI expander
KR101029074B1 (en) Apparatus and method for tracing descriptors in host controllers
CN201600142U (en) Strap-down attitude heading reference system
CN104572515B (en) Tracking module, method, system and on-chip system chip
CN104912874A (en) Testing and recording instrument for hydraulic system
CN116185917A (en) Intelligent processing and interface control unit architecture of distributed system
CN202795364U (en) Dynamically reconfigurable test measuring instrument
CN210466095U (en) Pipeline magnetic leakage internal detection data acquisition unit
CN110647091A (en) Pipeline magnetic leakage internal detection data acquisition unit and design and acquisition method thereof
Jue et al. Design of Modbus-Profibus fieldbus bridge based on the STM32 and VPC3+ C
CN102096607A (en) Microprocessor and debugging method thereof

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant