CN109634729A - A kind of parallel calculation method of inertial navigation equipment multi-core DSP - Google Patents

A kind of parallel calculation method of inertial navigation equipment multi-core DSP Download PDF

Info

Publication number
CN109634729A
CN109634729A CN201811383480.9A CN201811383480A CN109634729A CN 109634729 A CN109634729 A CN 109634729A CN 201811383480 A CN201811383480 A CN 201811383480A CN 109634729 A CN109634729 A CN 109634729A
Authority
CN
China
Prior art keywords
dsp
inertial navigation
core
parallel
data
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
Application number
CN201811383480.9A
Other languages
Chinese (zh)
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.)
707th Research Institute of CSIC
Original Assignee
707th Research Institute of CSIC
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 707th Research Institute of CSIC filed Critical 707th Research Institute of CSIC
Priority to CN201811383480.9A priority Critical patent/CN109634729A/en
Publication of CN109634729A publication Critical patent/CN109634729A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F9/00Arrangements for program control, e.g. control units
    • G06F9/06Arrangements for program control, e.g. control units using stored programs, i.e. using an internal store of processing equipment to receive or retain programs
    • G06F9/46Multiprogramming arrangements
    • G06F9/48Program initiating; Program switching, e.g. by interrupt
    • G06F9/4806Task transfer initiation or dispatching
    • G06F9/4843Task transfer initiation or dispatching by program, e.g. task dispatcher, supervisor, operating system
    • G06F9/4881Scheduling strategies for dispatcher, e.g. round robin, multi-level priority queues
    • 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/20Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Software Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • General Engineering & Computer Science (AREA)
  • Navigation (AREA)

Abstract

The present invention relates to a kind of parallel calculation methods of inertial navigation equipment multi-core DSP, and step is: step 1: inertial navigation equipment powers on CPU initialization;Step 2: distribution and creation multitask;Step 3: inertial navigation scheme being resolved according to multi-core parallel concurrent, TMS320C6657 model DSP is used to be resolved and communicated parallel for double-nuclear DSP;Step 4: verification experimental verification.The present invention makes full use of the performance of multi-core DSP parallel computation, resolves frequency to improve DSP, achievees the purpose that inhibit 3 d pose angular divergence fast under high dynamic environment.The present invention can be improved inertial navigation and resolve frequency, improve equipment response speed, it can be improved inertial navigation/odometer integrated navigation and location precision in a kind of degree, inhibit the 3 d pose error of the equipment in impact and vibratory test to dissipate fast effect simultaneously, there is preferable using effect in practical engineering applications.

Description

A kind of parallel calculation method of inertial navigation equipment multi-core DSP
Technical field
The invention belongs to navigator fix Service of Timing fields, are related to inertial navigation equipment, especially a kind of inertial navigation equipment The parallel calculation method of multi-core DSP.
Background technique
Currently, strap-down inertial equipment resolves frequency limit under high dynamic environment, by inertance element sample frequency and DSP System, especially impact, vibration and odometer integrated positioning orientative experiment, are acquired and are resolved frequency limit, equipment orientation accuracy It will appear the problem faster than dissipating under normal circumstances with positioning accuracy, it is normal under high dynamic environment to have seriously affected equipment It uses.It literature has shown that the country has tried to improve inertial reference calculation frequency using two CSTR mode, but is all with serial process Mode realize that computing speed room for promotion is limited, some scholars propose can be used monolithic FPGA realize multiprocessor simultaneously Row calculates, but does not further investigate.Common inertial navigation computation usually serially holds resolving process in order.Do not changing It is hardened under conditions of part, improves equipment sampling and resolving frequency generally has been approached the upper limit, and difficulty is larger, and use multicore DSP can provide computation capability, but be related to the planning of parallel computation, especially software parallel calculating and inertial navigation The parallel operation of resolving scheme.
By the retrieval of patent publication us, although thering are more to be related to the technology of multi-core DSP parallel processing, with the present invention The technical solution for inhibiting the fast problem of 3 d pose angular divergence under high dynamic environment involved in applying, not yet finds.
Summary of the invention
It is an object of the invention in place of overcome the deficiencies in the prior art, provide a kind of inertial navigation equipment multi-core DSP simultaneously Row calculation method, this method introduce multi-core DSP and carry out parallel computation, plan inertial navigation scheme process of solution by serial again Become parallel thinking, resolves frequency to achieve the purpose that improve inertial navigation, and then improve equipment and determine under high dynamic environment Position orientation accuracy.
The present invention realizes that the technical solution of purpose is:
A kind of parallel calculation method of inertial navigation equipment multi-core DSP, step is:
Step 1: inertial navigation equipment powers on CPU initialization:
It resolves plate DSP to power on, completes double-core initialization, configure interrupt vector table and interrupt number, hardware interrupts service (HWI) programmatic binding;Erroneous block is created, is prepared for multitask creation;
Step 2: distribution and creation multitask:
According to calculation amount size and logic sequencing, distribute independent task module it is multiple come complete inertial navigation resolve and Data communication facility;
Step 3: according to multi-core parallel concurrent resolve inertial navigation scheme, use TMS320C6657 model DSP for double-nuclear DSP into Row is parallel to be resolved and communicates:
Step 4: simulating, verifying.
Moreover, in the step 1 initialization of multi-core DSP include: the enabled configuration of peripheral hardware, the configuration of GPIO pin multiplexing, The initialization of GPIO pin, HWI initialization and wrong initialization block.
Moreover, the independent task module in the step 2 is respectively as follows: gyro pulse collection, accelerometer pulse collection, inner Journey meter pulse collection, Beidou synchronous signal acquisition, the calculating of earth parameter, speed update, posture renewal, location updating, Kalman Filter forecasting, Kalman filtering update, ethernet communication transmitting-receiving, CAN communication transmitting-receiving, serial communication is received and dispatched, mileage is counted and adopted Collection, Beidou data receiver.
Moreover, the specific implementation process of the step 2 are as follows:
To implement in strict accordance with following Period Process, previous step completion is the preceding topic condition that next step starts, and It is independent operating task module: first is that gyro pulse collection, accelerometer pulse collection, odometer pulse collection, Beidou Synchronous signal acquisition is basic data acquisition, as subsequent resolved data source;It is calculated second is that calculating earth parameter;Third is that strapdown Inertial navigation speed updates, attitude angle updates and location updating calculates;Fourth is that Kalman filtering is updated and is calculated with filtering in advance;Fifth is that into Row Ethernet, the data transmit-receive of CAN bus and serial ports, Beidou data and altimeter data and the data for debugging serial ports are received Hair.
Moreover, the specific implementation process of the step 3 is
The benefit for selecting real time operating system can be received and be given with sufficiently fast speed when extraneous event generates The result of processing, processing can control production process again within the defined time or make quick response to processing system, It dispatches all available resources and completes real-time task, and control the harmonious operation of all real-time tasks;Select TI company hair The TMS320C6657 type DSP of cloth is double-nuclear DSP, meets multi-core parallel concurrent and calculates demand;To balance DSP dual processors service performance, with CPU1 is that main core CPU2 is chondromitiome, and wherein equipment Self-debugging serial ports is reserved on main core, main core and chondromitiome shared drive and data Resource;Realized that the essence of real time operating system is exactly more using the SYS/BIOS real time operating system that TI company issues The same time carries out the calculating of different task on a CPU, thus achieve the purpose that parallel computation, and SYS/BIOS operating system It is the real time operating system based on multitask multipriority preemptive type;The SYS/BIOS component that specific Integrated Development external member uses It is related to clock, hard break and software interrupt, task and semaphore component.
The advantages and positive effects of the present invention are:
1, the present invention makes full use of the performance of multi-core DSP parallel computation, effectively improves DSP and resolves frequency, reaches dynamic in height The purpose for inhibiting 3 d pose angular divergence fast under state environment.
2, the present invention can be improved inertial navigation and resolve frequency, improves equipment response speed, can mention to a certain extent High inertial navigation/odometer integrated navigation and location precision, while inhibiting the 3 d pose error hair of the equipment in impact and vibratory test Fast effect is dissipated, there is preferable using effect in practical engineering applications.
Detailed description of the invention
Fig. 1 is 6657 initialization flowchart of multi-core DSP of the present invention;
Fig. 2, which is that the present invention is parallel, resolves inertial navigation scheme multi-task planning conceptual scheme;
Fig. 3 is the SYS/BIOS component drawings that Integrated Development external member of the present invention uses.
Fig. 4 is Kalman prediction and renewal process, in which: Xk-1And Pk-1Initially to give empirical value.
Specific embodiment
The embodiment of the present invention is further described below in conjunction with attached drawing;The present embodiment is descriptive, is not to limit Property, it cannot thus limit the scope of protection of the present invention.
A kind of parallel calculation method of inertial navigation equipment multi-core DSP, step is:
Step 1: inertial navigation equipment powers on CPU initialization:
It resolves plate DSP to power on, completes double-core initialization, configure interrupt vector table and interrupt number, hardware interrupts service (HWI) programmatic binding;Erroneous block is created, is prepared for multitask creation.
Fig. 1 show specific steps, and the initialization of multi-core DSP includes:
The enabled configuration of peripheral hardware, the configuration of GPIO pin multiplexing, the initialization of GPIO pin, HWI initialization and wrong initialization block.
Step 2: distribution and creation multitask:
According to calculation amount size and logic sequencing, independent task module 15 are distributed altogether and is resolved to complete inertial navigation And data communication facility.Task module are as follows: 1 gyro pulse collection, 2 accelerometer pulse collections, 3 odometer pulse collections, 4 Beidou synchronous signal acquisition, 5 earth parameters calculate, and 6 speed update, 7 posture renewals, 8 location updatings, and 9 Kalman filterings are pre- It surveys, 10 Kalman filterings update, the transmitting-receiving of 11 ethernet communications, 12CAN communication receiving/transmission, the transmitting-receiving of 13 serial communications, and 14 mileages count According to acquisition, 15 Beidou data receivers.
In this step, the gyro pulse collection, accelerometer pulse collection, odometer pulse and Beidou synchronization signal Acquisition tasks are the basic data sources of inertial navigation equipment, and High Precision Crystal Oscillator outside DSP is used to carry out timing generation interruption, The original pulse data for periodically (such as 1000Hz) reading inertia component are carried out to carry out driving DSP.
Earth parameter calculates, including terrestrial gravitation acceleration, earth meridian circle radius and prime vertical radius.As follows It calculates:
G=g0[1+0.00527094sin2L+0.0000232718sin4L]-0.000003086h
Speed, posture, the three classes of position update as follows using formula:
Inertial navigation direction cosine matrix are as follows:
Then: posture are as follows:
θ=sin-1(T32)
Speed are as follows:
Position are as follows:
Kalman prediction and renewal process are referring to fig. 4
The transmitting-receiving process of CAN bus and serial ports and Ethernet interface, be all made of FPGA extension kernel as DSP with outside The received intermediate conversion part in portion, process with read that the initial data of inertance element is same handles, i.e. the specified ground of periodic reading Location space then carries out the reading of total data if there is buffered data according to buffered data space size, rather than in using Disconnected mode.According to engineering experience using the method for intermediate conversion part than using DSP directly to be communicated with external interface Mode has more stability and reliability.
The module created in step 2 creates a task, in operating system, according to priority implementation process Carry out Automatic dispatching.The task module for being laterally in Fig. 2 while starting, it is same in main core CPU and chondromitiome heart core cpu Shi Jinhang parallel computation;Longitudinally in chronological sequence sequentially to create and operating in the task module on different core cpus in Fig. 2, Previous task module just starts the calculating of next task module after the completion of calculating.Main core CPU is by task order on the left of Fig. 2 It executes, secondary core CPU is executed by task order on the right side of Fig. 2 at the same time, to reach the distribution of double-core CPU task, is reached simultaneously The purpose that row resolves.
Step 3: inertial navigation scheme is resolved according to multi-core parallel concurrent, is resolved and is communicated parallel:
The benefit for selecting real time operating system can be received and be given with sufficiently fast speed when extraneous event generates The result of processing, processing can control production process again within the defined time or make quick response to processing system, It dispatches all available resources and completes real-time task, and control the harmonious operation of all real-time tasks.The publication of TI company TMS320C6657 type DSP is double-nuclear DSP, meets multi-core parallel concurrent and calculates demand, can use policy control multitask appropriate Execution, improve the utilization efficiency of resource.The utilization rate of CPU can be made greatly to be played, complicated application layer Secondaryization makes dsp software laser be easy design and maintenance.It is that main core CPU2 is with CPU1 to balance DSP dual processors service performance Chondromitiome, wherein equipment Self-debugging serial ports is reserved on main core, and main core and chondromitiome shared drive and data resource were embodied Journey is shown in Fig. 2.The specific implementation process of the step are as follows:
The present invention uses the SYS/BIOS real time operating system of TI company publication to realize, the essence of real time operating system It is exactly the calculating of the same time progress different task on multiple CPU, thus achieve the purpose that parallel computation, and SYS/BIOS Operating system is the real time operating system based on multitask multipriority preemptive type.The SYS/ that specific Integrated Development external member uses BIOS component is as shown in figure 3, be related to clock, hard break and software interrupt, task and semaphore component.
Step 4: verification experimental verification:
After implementing according to above-mentioned steps one, two, three, experiment proves that, the inertial navigation equipment resolving time is contracted by 1.25ms 0.57ms is reduced to, raising efficiency is about 45%, wherein about 5% is that double-nuclear DSP carries out resource-sharing and internuclear communication and operation system Expense of uniting occupies, and by using parallel calculation method, the parallel process of solution of reasonable distribution inertial navigation equipment has reached promotion Resolve the purpose of frequency.

Claims (5)

1. a kind of parallel calculation method of inertial navigation equipment multi-core DSP, it is characterised in that: step is:
Step 1: inertial navigation equipment powers on CPU initialization:
It resolves plate DSP to power on, completes double-core initialization, configure interrupt vector table and interrupt number, hardware interrupts service (HWI) journey Sequence binding;Erroneous block is created, is prepared for multitask creation;
Step 2: distribution and creation multitask:
According to calculation amount size and logic sequencing, distribute that independent task module is multiple to be resolved and data to complete inertial navigation Communication function;
Step 3: inertial navigation scheme being resolved according to multi-core parallel concurrent, TMS320C6657 model DSP is used to carry out simultaneously for double-nuclear DSP Row resolves and communication:
Step 4: simulating, verifying.
2. the parallel calculation method of inertial navigation equipment multi-core DSP according to claim 1, it is characterised in that: the step 1 The initialization of middle multi-core DSP includes: the enabled configuration of peripheral hardware, the configuration of GPIO pin multiplexing, the initialization of GPIO pin, HWI initialization And wrong initialization block.
3. the parallel calculation method of inertial navigation equipment multi-core DSP according to claim 1, it is characterised in that: the step 2 In independent task module to be respectively as follows: gyro pulse collection, accelerometer pulse collection, odometer pulse collection, Beidou synchronous Signal acquisition, the calculating of earth parameter, speed update, posture renewal, location updating, Kalman prediction, Kalman filtering are more Newly, ethernet communication transmitting-receiving, CAN communication transmitting-receiving, serial communication transmitting-receiving, mileage count acquisition, Beidou data receiver.
4. the parallel calculation method of inertial navigation equipment multi-core DSP according to claim 3, it is characterised in that: the step 2 Specific implementation process are as follows:
Implement in strict accordance with following Period Process, previous step completion is the preceding topic condition that next step starts, and is Independent operating task module: first is that the synchronous letter of gyro pulse collection, accelerometer pulse collection, odometer pulse collection, Beidou Number acquisition is basic data acquisition, as subsequent resolved data source;It is calculated second is that calculating earth parameter;Third is that inertial navigation speed It updates, attitude angle updates and location updating calculates;Fourth is that Kalman filtering is updated and is calculated with filtering in advance;Fifth is that progress Ethernet, The data transmit-receive of CAN bus and serial ports, Beidou data and altimeter data and the data transmit-receive for debugging serial ports.
5. the parallel calculation method of inertial navigation equipment multi-core DSP according to claim 1, it is characterised in that: the step 3 Specific implementation process be
Select real time operating system benefit be when extraneous event generate when, can receive and with sufficiently fast speed at The result of reason, processing can control production process again within the defined time or make quick response to processing system, adjust It spends all available resources and completes real-time task, and control the harmonious operation of all real-time tasks;Select the publication of TI company TMS320C6657 type DSP be double-nuclear DSP, meet multi-core parallel concurrent calculate demand;To balance DSP dual processors service performance, with CPU1 is that main core CPU2 is chondromitiome, and wherein equipment Self-debugging serial ports is reserved on main core, main core and chondromitiome shared drive and data Resource;Realized that the essence of real time operating system is exactly more using the SYS/BIOS real time operating system that TI company issues The same time carries out the calculating of different task on a CPU, thus achieve the purpose that parallel computation, and SYS/BIOS operating system is Real time operating system based on multitask multipriority preemptive type;The SYS/BIOS component that specific Integrated Development external member uses is related to To clock, hard break and software interrupt, task and semaphore component.
CN201811383480.9A 2018-11-20 2018-11-20 A kind of parallel calculation method of inertial navigation equipment multi-core DSP Pending CN109634729A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811383480.9A CN109634729A (en) 2018-11-20 2018-11-20 A kind of parallel calculation method of inertial navigation equipment multi-core DSP

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811383480.9A CN109634729A (en) 2018-11-20 2018-11-20 A kind of parallel calculation method of inertial navigation equipment multi-core DSP

Publications (1)

Publication Number Publication Date
CN109634729A true CN109634729A (en) 2019-04-16

Family

ID=66068630

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811383480.9A Pending CN109634729A (en) 2018-11-20 2018-11-20 A kind of parallel calculation method of inertial navigation equipment multi-core DSP

Country Status (1)

Country Link
CN (1) CN109634729A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112146653A (en) * 2020-08-03 2020-12-29 河北汉光重工有限责任公司 Method for improving integrated navigation resolving frequency
CN112857363A (en) * 2021-01-08 2021-05-28 中国船舶重工集团公司第七0七研究所 Communication system integrating multiple communication modes and multi-state data simulation

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102089752A (en) * 2008-07-10 2011-06-08 洛克泰克科技有限公司 Efficient parallel computation of dependency problems
CN105260164A (en) * 2015-09-25 2016-01-20 北京航空航天大学 Multi-core SoC architecture design method supporting multi-task parallel execution
CN105319569A (en) * 2014-07-15 2016-02-10 北京自动化控制设备研究所 Multi-core DSP based inertial/satellite deep integration information processing hardware platform
EP3101876A1 (en) * 2015-06-02 2016-12-07 Goodrich Corporation Parallel caching architecture and methods for block-based data processing
CN107357666A (en) * 2017-06-26 2017-11-17 西安微电子技术研究所 A kind of multi-core parallel concurrent system processing method based on hardware protection
CN107796389A (en) * 2017-10-17 2018-03-13 北京航天发射技术研究所 A kind of positioning navigation method based on multi-core DSP

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102089752A (en) * 2008-07-10 2011-06-08 洛克泰克科技有限公司 Efficient parallel computation of dependency problems
CN105319569A (en) * 2014-07-15 2016-02-10 北京自动化控制设备研究所 Multi-core DSP based inertial/satellite deep integration information processing hardware platform
EP3101876A1 (en) * 2015-06-02 2016-12-07 Goodrich Corporation Parallel caching architecture and methods for block-based data processing
CN105260164A (en) * 2015-09-25 2016-01-20 北京航空航天大学 Multi-core SoC architecture design method supporting multi-task parallel execution
CN107357666A (en) * 2017-06-26 2017-11-17 西安微电子技术研究所 A kind of multi-core parallel concurrent system processing method based on hardware protection
CN107796389A (en) * 2017-10-17 2018-03-13 北京航天发射技术研究所 A kind of positioning navigation method based on multi-core DSP

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
丁有源等: "基于多核任务并行处理的DSP软硬件设计", 《单片机与嵌入式系统应用》 *
洪汉玉, 国防工业出版社 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112146653A (en) * 2020-08-03 2020-12-29 河北汉光重工有限责任公司 Method for improving integrated navigation resolving frequency
CN112857363A (en) * 2021-01-08 2021-05-28 中国船舶重工集团公司第七0七研究所 Communication system integrating multiple communication modes and multi-state data simulation

Similar Documents

Publication Publication Date Title
Furht et al. Real-time UNIX® Systems: design and application guide
CN100476853C (en) SINS/CNS/GPS Combined navigation semi-entity copying system
CN102307369A (en) Device and method for supporting parallel simulation and physical simulation of wireless sensor network
CN109634729A (en) A kind of parallel calculation method of inertial navigation equipment multi-core DSP
CN101876710A (en) Real-time satellite signal simulator based device for synchronously increasing and decreasing visible satellites and construction method thereof
CN103675834A (en) Indoor satellite signal simulation system
WO2022087442A1 (en) User-space emulation framework for heterogeneous soc design
CN114490036A (en) Extensible distributed redundancy unmanned aerial vehicle intelligent flight control computer
Glonina et al. On the correctness of real-time modular computer systems modeling with stopwatch automata networks
CN110940336B (en) Strapdown inertial navigation simulation positioning resolving method and device and terminal equipment
Rico et al. Hardware and rtos design of a flight controller for professional applications
CN112114945A (en) Inertial/satellite integrated navigation task scheduling method based on multi-task real-time operating system
Wan et al. A time-aware programming framework for constructing predictable real-time systems
CN201673260U (en) Synchronous increase and decrease visible satellite equipment based on real-time satellite signal simulator
Pree et al. TDL-Steps Beyond Giotto: A Case for Automated Software Construction.
Sokolov et al. Complex simulation of automated control system of navigation spacecraft operation
Shafiei et al. Concurrent runtime verification of data rich events
CN112630821B (en) Variable frequency control device applied to seismic data acquisition and control method thereof
CN110750869B (en) Design method of multi-component dynamics simulation module of attitude and orbit control system
Hsiung et al. Quasi-dynamic scheduling for the synthesis of real-time embedded software with local and global deadlines
Furht et al. Introduction to real-time computing
Weiderman Evaluating real-time performance of Ada implementations
von der Brüggen et al. Functionally Safe Multi-Core Systems (Dagstuhl Seminar 23341)
Yang Sharing GPUS for Real-Time Autonomous-Driving Systems
Kiesel et al. Real time implementation of a non-coherent deeply coupled GPS/INS system

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20190416

RJ01 Rejection of invention patent application after publication