SlideShare a Scribd company logo
12
Most read
16
Most read
17
Most read
MULTISENSOR DATA FUSION FOR DEFENSE APPLICATION  Othman Sidek  and S.A.Quadri Collaborative µ-electronic Design Excellence Centre Universiti Sains Malaysia
DATA FUSION  Data-fusion is a problem-solving technique based on the idea of integrating many answers to a question into a single;  best answer. Process of combining inputs from various sensors to provide a robust and complete description of an environment or process of interest. Multilevel, multifaceted process dealing with the automatic detection, association, correlation , estimation, and combination of data and information from single and multiple sources. “ Properly said, fusion is neither a theory nor a technology in its own. It is a concept which uses various techniques pertaining to information theory, artificial intelligence and statistics  [1] ”  [1] Dave L. Hall and James Llinas, “Introduction to Multisensor  Data Fusion”,  IEEE , Vol. 85, No. 1, pp. 6 – 23, Jan 1997.
Multisensor data fusion Applications : Military application : Location and characterization of enemy units and weapons High level inferences about enemy situation Air to air or surface to air defense Ocean monitoring Battlefield intelligence Strategic warning Non military applications: Condition based maintenance Detection of system faults Robotics Medical Environmental monitoring Location and identification of natural phenomena
DATA FUSION APPLICATION IN ESTIMATION PROBLEMS Application  Dynamic system Sensor Types Process control  Chemical plant  Pressure  Temperature  Flow rate Gas analyzer  Flood predication  River system Water level Rain gauge Weather radar  Tracking  Spacecraft  Radar Imaging system  Navigation Ship Sextant  Log Gyroscope  Accelerometer  Global Navigation satellite system
Data fusion plays a critical and fundamental role in defense and national security Areas of surveillance Intelligence analysis for timely situational awareness. Intelligence analysis is inherently a multi-modal multi-source data fusion operation.  Raw intelligence can come from multitude of sources, such as  SIGNT  => Signals intelligence  is intelligence-gathering by interception of signals.  COMINT  => Communications intelligence  between people. ELINT  => Electronic intelligence between electronic signals.
On the battlefield, data fusion may involve integrating data from several sensors  Radars Infra Red sensors  Acoustic sensors  For arms control and verification, data fusion  involve integrating data from Multispectral satellite images  Ground-based sensors  On-site inspections for better analysis.
RSTAKA Function  Reconnaissance, Surveillance, Target Acquisition, and Kill Assessment  functions where data from a variety of sensors must be integrated to deal effectively with many targets of different types. In the defense domain, a target such as a tank or a missile carrier may be located in desert, swampy, or rolling terrain. Targets can exhibit behaviors such as moving, rotating a turret, firing, erecting a missile, or launching a missile. Again certain behaviors are only appropriate with certain types of targets. A target exhibiting a behavior in an environment generates a signature.  A launcher firing a missile generates a number of signatures  —  visual, radar, thermal, acoustic, and seismic. However, the appearance of these signatures may be affected by the environment in which they occur.
A surveillance spacecraft may have a set of sensors to track the status of different critical subsystems.  It is of great importance to be able to fuse information from these sensors to create a global picture of the health of the spacecraft  Which  allow  to predict an impending failure and correct it before it reaches criticality.
Data Fusion Methodology  Data fusion requires combining expertise in two areas Sensors  Information integration. Data fusion is essentially an information integration problem. Data fusion can be categorized into three main classes based on the level of information abstraction used for fusion: Raw data fusion  : Primarily limited to fusion of homogeneous modalities.    It requires the different data sets to be properly aligned for correlation at the lowest level of information granularity.  (ii )  Feature vector fusion : Feature extractor is co-located with the sensor and the feature vectors  are sent to the fusion node. (iii )  Decision fusion  : Combines information at the highest level of abstraction but requires significant computational capabilities  in the sensor nodes,
Multisensor data fusion provides significant advantages over single source data Improves accuracy  Improves  precision  Supports  effective decision making  Schematic diagram of data fusion
MISSILE GUIDANCE SYSTEM A system which evaluates Flight information, Correlates it with target data,  Determines the desired flight path of a missile,  Communicates the necessary commands to the missile flight control system. The missile's target accuracy is a critical factor for its effectiveness.  Guidance systems improve missile accuracy by improving its "Single Shot Kill Probability" (SSKP). Guidance systems are divided into different categories  Go-Onto-Target (GOT): A GOT missile can target either a moving or fixed target. Go-Onto-Location-in-Space (GOLIS) guidance systems: GOLIS weapon is limited to a stationary target.  The trajectory that a missile takes while attacking a moving target is dependent upon the movement of the target.
In every GOT system, there are three subsystems: Target tracker  Missile tracker  Guidance computer  The way these three subsystems are distributed between the missile and the launcher result in two different categories: Remote Control Guidance:  The guidance computer and target tracker  are on the launching platform.  Homing Guidance:  The guidance computers are in the missile and in the target tracker.
SIMULATION OF TARGET TRACKING AND ESTIMATION USING DATA FUSION Objective: Target tracking and estimation of a moving object  Sensors required: Multiple sensors  => Position estimation sensors    => Velocity estimation sensors  Need for heterogeneous multi sensors ? =>It is not possible to deduce a comprehensive picture about the entire target scenario from each of the pieces of evidence alone.  =>Due to the inherent limitations of technical features characterizing each sensor. Coordinate system Selected : Cartesian coordinate system Technique applied : Multisensor data fusion using Kalman filter
Kalman filter  The Kalman filter produces estimates of the true values of measurements and their associated calculated values by  Predicting a value,  Estimating the uncertainty of the predicted value,  and computing a weighted average of the predicted value and the measured value.  The most weight is given to the value with the least uncertainty.  The estimates produced by the method tend to be closer to the true values than the original measurements . Weighted average has a better-estimated uncertainty than either of the values that went into the weighted average. Kalman filter uses  System's dynamics model (i.e., physical laws of motion), Known control inputs to that system,  Measurements  from sensors to form an estimate of the system's varying quantities (its state)  that is better than the estimate obtained by using any one measurement alone.  Squares represent matrices. Ellipses represent multivariate normal distributions (with the mean and covariance matrix enclosed). Unenclosed values are vectors.  F k  is the state transition model, which is applied to the previous state x k−1 ;  B k  is the control-input model, which is applied to the control vector U k ;  W k  is the process noise, which is assumed to be drawn from a zero mean multivariate normal distribution with covariance Q k .(also denoted by  v i
Simulation has been carried out by with two-dimensional state model of the moving object along x; y and z directions. The program is executed in Mat lab environment .
As shown in figure estimation using state vector fusion method using Kalman filter is more close and accurate to actual track.
Sample code % Missile_Launcher tracking Moving_Object  using kalman filter clear all %% define our meta-variables (i.e. how long and often we will sample) duration = 10  %how long the Moving_Object  flies dt = .1;  %The Missile_Launcher continuously looks for the Object-in-motion , %but we'll assume he's just repeatedly sampling over time at a fixed interval %% Define update equations (Coefficent matrices): A physics based model for A = [1 dt; 0 1] ; % state transition matrix:  expected flight of the Moving_Object  (state prediction) B = [dt^2/2; dt]; %input control matrix:  expected effect of the input accceleration on the state. C = [1 0]; % measurement matrix: the expected measurement given %% define main variables u = 1.5; % define acceleration magnitude Q= [0; 0]; %initized state--it has two components: [position; velocity] of the Moving_Object  Q_estimate = Q;  %x_estimate of initial location estimation of where the Moving_Object  Moving_ObjectAccel_noise_mag = 0.05; %process noise: the variability in  Q_loc = []; % ACTUAL Moving_Object  flight path vel = []; % ACTUAL Moving_Object  velocity Q_loc_meas = []; % Moving_Object  path that the Missile_Launcher sees %% simulate what the Missile_Launcher sees over time figure(2);clf  figure(1);clf  % Generate the Moving_Object  flight Moving_ObjectAccel_noise = Moving_ObjectAccel_noise_mag * [(dt^2/2)*randn; dt*randn]; Q= A * Q+ B * u + Moving_ObjectAccel_noise; ......................... pause end %plot theoretical path of Missile_Launcher that doesn't use kalman  plot(0:dt:t, smooth(Q_loc_meas), '-g.') %plot(0:dt:t, vel, '-b.') %% Do kalman filtering %initize estimation variables ......................... % Plot the results figure(2); plot(tt,Q_loc,'-r.',tt,Q_loc_meas,'-k.', tt,Q_loc_estimate,'-g.'); %data measured by the Missile_Launcher  ……………………… .. %combined position estimate mu = Q_loc_estimate(T); % mean sigma = P_mag_estimate(T); % standard deviation y = normpdf(x,mu,sigma); % pdf  y = y/(max(y)); hl = line(x,y, 'Color','g'); % or use hold on and normal plot axis([Q_loc_estimate(T)-5 Q_loc_estimate(T)+5 0 1]);  %actual position of the Moving_Object  plot(Q_loc(T));  ylim=get(gca,'ylim'); line([Q_loc(T);Q_loc(T)],ylim.','linewidth',2,'color','b'); legend('state predicted','measurement','state estimate','actual Moving_Object  position') pause end

More Related Content

PPT
Multisensor data fusion in object tracking applications
PDF
Multisensor Data Fusion : Techno Briefing
PDF
Multi sensor-fusion
PPTX
drone technology
PPTX
Global Positioning System (GPS)
PPTX
Radar fundamentals
PPTX
Implementation of INS-GPS
PPT
Air Traffic Control Center
Multisensor data fusion in object tracking applications
Multisensor Data Fusion : Techno Briefing
Multi sensor-fusion
drone technology
Global Positioning System (GPS)
Radar fundamentals
Implementation of INS-GPS
Air Traffic Control Center

What's hot (20)

PPTX
Aircraft navigation system
PPT
Radio And Satellite Navigation
PPTX
Unmanned aerial vehicles
PPT
Inertial Navigation System
PPTX
missile autopilot
PPTX
Unmanned aerial vehicle (uav)
PPTX
Satellite Systems
PPTX
Uav presentation
ODT
PPTX
Data fusion
PPTX
Artificial Intelligence Drone
PPTX
INS-Inertial Navigation System
PPTX
Secondary Surveillance Radar, Mode-S and ADS-B
PPT
Satellite communications ppt
PPTX
5.1 Electronic Instrument Systems
PPTX
Google Driverless Car
PPTX
Distance measuring equipment
PPTX
Airborne radar
PDF
Satellite Subsystems
PPTX
Sensor technology
Aircraft navigation system
Radio And Satellite Navigation
Unmanned aerial vehicles
Inertial Navigation System
missile autopilot
Unmanned aerial vehicle (uav)
Satellite Systems
Uav presentation
Data fusion
Artificial Intelligence Drone
INS-Inertial Navigation System
Secondary Surveillance Radar, Mode-S and ADS-B
Satellite communications ppt
5.1 Electronic Instrument Systems
Google Driverless Car
Distance measuring equipment
Airborne radar
Satellite Subsystems
Sensor technology
Ad

Viewers also liked (10)

PDF
Multisensor Fusion and Integration - pres
PPT
Data fusion with kalman filtering
PPT
Data fusion with kalman filtering
PPTX
The generalized SLAM framework
PPTX
Search Engine Query Suggestion Application
PDF
Sensor fusion between car and smartphone
PPT
Data fusion in sensor network
PDF
IoT and the Autonomous Vehicle in the Clouds: Simultaneous Localization and M...
PPTX
Virtualizing Analytics with Apache Spark: Keynote by Arsalan Tavakoli
PDF
Better motion control using accelerometer/gyroscope sensor fusion
Multisensor Fusion and Integration - pres
Data fusion with kalman filtering
Data fusion with kalman filtering
The generalized SLAM framework
Search Engine Query Suggestion Application
Sensor fusion between car and smartphone
Data fusion in sensor network
IoT and the Autonomous Vehicle in the Clouds: Simultaneous Localization and M...
Virtualizing Analytics with Apache Spark: Keynote by Arsalan Tavakoli
Better motion control using accelerometer/gyroscope sensor fusion
Ad

Similar to Multisensor data fusion for defense application (20)

PDF
Design of Kalman filter for Airborne Applications
PPT
Intro to Multitarget Tracking for CURVE
PDF
International Journal of Engineering and Science Invention (IJESI)
PDF
Toward intelligent health monitoring system for space missions
PDF
An Enhanced Predictive Proportion using TMP Algorithm in WSN Navigation
PDF
MMekni Poster V0.2
PDF
C1802022430
PDF
E010412433
PDF
A CUSTOMIZED FLOCKING ALGORITHM FOR SWARMS OF SENSORS TRACKING A SWARM OF TAR...
PDF
IRJET- Survey on Flood Management System
PDF
A CUSTOMIZED FLOCKING ALGORITHM FOR SWARMS OF SENSORS TRACKING A SWARM OF TAR...
PDF
Image-Based Multi-Sensor Data Representation and Fusion Via 2D Non-Linear Con...
PPTX
Multi agent system to monitor structures
PDF
Drone Based Radiation Detection System.pdf
PDF
An optical satellite tracking system for undergraduate research bruski, jon...
PDF
Eecs221 final report
PDF
EECS221 - Final Report
PDF
Indoor localisation and dead reckoning using Sensor Tag™ BLE.
PDF
Nuzzer algorithm based Human Tracking and Security System for Device-Free Pas...
PDF
Af03301980202
Design of Kalman filter for Airborne Applications
Intro to Multitarget Tracking for CURVE
International Journal of Engineering and Science Invention (IJESI)
Toward intelligent health monitoring system for space missions
An Enhanced Predictive Proportion using TMP Algorithm in WSN Navigation
MMekni Poster V0.2
C1802022430
E010412433
A CUSTOMIZED FLOCKING ALGORITHM FOR SWARMS OF SENSORS TRACKING A SWARM OF TAR...
IRJET- Survey on Flood Management System
A CUSTOMIZED FLOCKING ALGORITHM FOR SWARMS OF SENSORS TRACKING A SWARM OF TAR...
Image-Based Multi-Sensor Data Representation and Fusion Via 2D Non-Linear Con...
Multi agent system to monitor structures
Drone Based Radiation Detection System.pdf
An optical satellite tracking system for undergraduate research bruski, jon...
Eecs221 final report
EECS221 - Final Report
Indoor localisation and dead reckoning using Sensor Tag™ BLE.
Nuzzer algorithm based Human Tracking and Security System for Device-Free Pas...
Af03301980202

More from Sayed Abulhasan Quadri (7)

PDF
What is over-the-air programming
PPT
Decentralized Data Fusion Algorithm using Factor Analysis Model
PPT
Image quality improvement of Low-resolution camera using Data fusion technique
PPT
What is spatial Resolution
PPT
Feature Extraction and Principal Component Analysis
PPT
Multi sensor data fusion system for enhanced analysis of deterioration in con...
PPT
Sensor based structural health monitoring of concrete structures
What is over-the-air programming
Decentralized Data Fusion Algorithm using Factor Analysis Model
Image quality improvement of Low-resolution camera using Data fusion technique
What is spatial Resolution
Feature Extraction and Principal Component Analysis
Multi sensor data fusion system for enhanced analysis of deterioration in con...
Sensor based structural health monitoring of concrete structures

Recently uploaded (20)

PDF
Sports Quiz easy sports quiz sports quiz
PDF
Chapter 2 Heredity, Prenatal Development, and Birth.pdf
PPTX
GDM (1) (1).pptx small presentation for students
PPTX
Institutional Correction lecture only . . .
PPTX
Final Presentation General Medicine 03-08-2024.pptx
PDF
FourierSeries-QuestionsWithAnswers(Part-A).pdf
PPTX
master seminar digital applications in india
PDF
Supply Chain Operations Speaking Notes -ICLT Program
PPTX
PPT- ENG7_QUARTER1_LESSON1_WEEK1. IMAGERY -DESCRIPTIONS pptx.pptx
PPTX
Pharmacology of Heart Failure /Pharmacotherapy of CHF
PPTX
Microbial diseases, their pathogenesis and prophylaxis
PDF
Classroom Observation Tools for Teachers
PPTX
school management -TNTEU- B.Ed., Semester II Unit 1.pptx
PPTX
Renaissance Architecture: A Journey from Faith to Humanism
PDF
RMMM.pdf make it easy to upload and study
PDF
Abdominal Access Techniques with Prof. Dr. R K Mishra
PDF
Saundersa Comprehensive Review for the NCLEX-RN Examination.pdf
PDF
Complications of Minimal Access Surgery at WLH
PDF
Pre independence Education in Inndia.pdf
PPTX
Cell Types and Its function , kingdom of life
Sports Quiz easy sports quiz sports quiz
Chapter 2 Heredity, Prenatal Development, and Birth.pdf
GDM (1) (1).pptx small presentation for students
Institutional Correction lecture only . . .
Final Presentation General Medicine 03-08-2024.pptx
FourierSeries-QuestionsWithAnswers(Part-A).pdf
master seminar digital applications in india
Supply Chain Operations Speaking Notes -ICLT Program
PPT- ENG7_QUARTER1_LESSON1_WEEK1. IMAGERY -DESCRIPTIONS pptx.pptx
Pharmacology of Heart Failure /Pharmacotherapy of CHF
Microbial diseases, their pathogenesis and prophylaxis
Classroom Observation Tools for Teachers
school management -TNTEU- B.Ed., Semester II Unit 1.pptx
Renaissance Architecture: A Journey from Faith to Humanism
RMMM.pdf make it easy to upload and study
Abdominal Access Techniques with Prof. Dr. R K Mishra
Saundersa Comprehensive Review for the NCLEX-RN Examination.pdf
Complications of Minimal Access Surgery at WLH
Pre independence Education in Inndia.pdf
Cell Types and Its function , kingdom of life

Multisensor data fusion for defense application

  • 1. MULTISENSOR DATA FUSION FOR DEFENSE APPLICATION Othman Sidek and S.A.Quadri Collaborative µ-electronic Design Excellence Centre Universiti Sains Malaysia
  • 2. DATA FUSION Data-fusion is a problem-solving technique based on the idea of integrating many answers to a question into a single; best answer. Process of combining inputs from various sensors to provide a robust and complete description of an environment or process of interest. Multilevel, multifaceted process dealing with the automatic detection, association, correlation , estimation, and combination of data and information from single and multiple sources. “ Properly said, fusion is neither a theory nor a technology in its own. It is a concept which uses various techniques pertaining to information theory, artificial intelligence and statistics [1] ” [1] Dave L. Hall and James Llinas, “Introduction to Multisensor Data Fusion”, IEEE , Vol. 85, No. 1, pp. 6 – 23, Jan 1997.
  • 3. Multisensor data fusion Applications : Military application : Location and characterization of enemy units and weapons High level inferences about enemy situation Air to air or surface to air defense Ocean monitoring Battlefield intelligence Strategic warning Non military applications: Condition based maintenance Detection of system faults Robotics Medical Environmental monitoring Location and identification of natural phenomena
  • 4. DATA FUSION APPLICATION IN ESTIMATION PROBLEMS Application Dynamic system Sensor Types Process control Chemical plant Pressure Temperature Flow rate Gas analyzer Flood predication River system Water level Rain gauge Weather radar Tracking Spacecraft Radar Imaging system Navigation Ship Sextant Log Gyroscope Accelerometer Global Navigation satellite system
  • 5. Data fusion plays a critical and fundamental role in defense and national security Areas of surveillance Intelligence analysis for timely situational awareness. Intelligence analysis is inherently a multi-modal multi-source data fusion operation. Raw intelligence can come from multitude of sources, such as SIGNT => Signals intelligence is intelligence-gathering by interception of signals. COMINT => Communications intelligence between people. ELINT => Electronic intelligence between electronic signals.
  • 6. On the battlefield, data fusion may involve integrating data from several sensors Radars Infra Red sensors Acoustic sensors For arms control and verification, data fusion involve integrating data from Multispectral satellite images Ground-based sensors On-site inspections for better analysis.
  • 7. RSTAKA Function Reconnaissance, Surveillance, Target Acquisition, and Kill Assessment functions where data from a variety of sensors must be integrated to deal effectively with many targets of different types. In the defense domain, a target such as a tank or a missile carrier may be located in desert, swampy, or rolling terrain. Targets can exhibit behaviors such as moving, rotating a turret, firing, erecting a missile, or launching a missile. Again certain behaviors are only appropriate with certain types of targets. A target exhibiting a behavior in an environment generates a signature. A launcher firing a missile generates a number of signatures — visual, radar, thermal, acoustic, and seismic. However, the appearance of these signatures may be affected by the environment in which they occur.
  • 8. A surveillance spacecraft may have a set of sensors to track the status of different critical subsystems. It is of great importance to be able to fuse information from these sensors to create a global picture of the health of the spacecraft Which allow to predict an impending failure and correct it before it reaches criticality.
  • 9. Data Fusion Methodology Data fusion requires combining expertise in two areas Sensors Information integration. Data fusion is essentially an information integration problem. Data fusion can be categorized into three main classes based on the level of information abstraction used for fusion: Raw data fusion : Primarily limited to fusion of homogeneous modalities. It requires the different data sets to be properly aligned for correlation at the lowest level of information granularity. (ii ) Feature vector fusion : Feature extractor is co-located with the sensor and the feature vectors are sent to the fusion node. (iii ) Decision fusion : Combines information at the highest level of abstraction but requires significant computational capabilities in the sensor nodes,
  • 10. Multisensor data fusion provides significant advantages over single source data Improves accuracy Improves precision Supports effective decision making Schematic diagram of data fusion
  • 11. MISSILE GUIDANCE SYSTEM A system which evaluates Flight information, Correlates it with target data, Determines the desired flight path of a missile, Communicates the necessary commands to the missile flight control system. The missile's target accuracy is a critical factor for its effectiveness. Guidance systems improve missile accuracy by improving its "Single Shot Kill Probability" (SSKP). Guidance systems are divided into different categories Go-Onto-Target (GOT): A GOT missile can target either a moving or fixed target. Go-Onto-Location-in-Space (GOLIS) guidance systems: GOLIS weapon is limited to a stationary target. The trajectory that a missile takes while attacking a moving target is dependent upon the movement of the target.
  • 12. In every GOT system, there are three subsystems: Target tracker Missile tracker Guidance computer The way these three subsystems are distributed between the missile and the launcher result in two different categories: Remote Control Guidance: The guidance computer and target tracker are on the launching platform. Homing Guidance: The guidance computers are in the missile and in the target tracker.
  • 13. SIMULATION OF TARGET TRACKING AND ESTIMATION USING DATA FUSION Objective: Target tracking and estimation of a moving object Sensors required: Multiple sensors => Position estimation sensors => Velocity estimation sensors Need for heterogeneous multi sensors ? =>It is not possible to deduce a comprehensive picture about the entire target scenario from each of the pieces of evidence alone. =>Due to the inherent limitations of technical features characterizing each sensor. Coordinate system Selected : Cartesian coordinate system Technique applied : Multisensor data fusion using Kalman filter
  • 14. Kalman filter The Kalman filter produces estimates of the true values of measurements and their associated calculated values by Predicting a value, Estimating the uncertainty of the predicted value, and computing a weighted average of the predicted value and the measured value. The most weight is given to the value with the least uncertainty. The estimates produced by the method tend to be closer to the true values than the original measurements . Weighted average has a better-estimated uncertainty than either of the values that went into the weighted average. Kalman filter uses System's dynamics model (i.e., physical laws of motion), Known control inputs to that system, Measurements from sensors to form an estimate of the system's varying quantities (its state) that is better than the estimate obtained by using any one measurement alone. Squares represent matrices. Ellipses represent multivariate normal distributions (with the mean and covariance matrix enclosed). Unenclosed values are vectors. F k is the state transition model, which is applied to the previous state x k−1 ; B k is the control-input model, which is applied to the control vector U k ; W k is the process noise, which is assumed to be drawn from a zero mean multivariate normal distribution with covariance Q k .(also denoted by v i
  • 15. Simulation has been carried out by with two-dimensional state model of the moving object along x; y and z directions. The program is executed in Mat lab environment .
  • 16. As shown in figure estimation using state vector fusion method using Kalman filter is more close and accurate to actual track.
  • 17. Sample code % Missile_Launcher tracking Moving_Object using kalman filter clear all %% define our meta-variables (i.e. how long and often we will sample) duration = 10 %how long the Moving_Object flies dt = .1; %The Missile_Launcher continuously looks for the Object-in-motion , %but we'll assume he's just repeatedly sampling over time at a fixed interval %% Define update equations (Coefficent matrices): A physics based model for A = [1 dt; 0 1] ; % state transition matrix: expected flight of the Moving_Object (state prediction) B = [dt^2/2; dt]; %input control matrix: expected effect of the input accceleration on the state. C = [1 0]; % measurement matrix: the expected measurement given %% define main variables u = 1.5; % define acceleration magnitude Q= [0; 0]; %initized state--it has two components: [position; velocity] of the Moving_Object Q_estimate = Q; %x_estimate of initial location estimation of where the Moving_Object Moving_ObjectAccel_noise_mag = 0.05; %process noise: the variability in Q_loc = []; % ACTUAL Moving_Object flight path vel = []; % ACTUAL Moving_Object velocity Q_loc_meas = []; % Moving_Object path that the Missile_Launcher sees %% simulate what the Missile_Launcher sees over time figure(2);clf figure(1);clf % Generate the Moving_Object flight Moving_ObjectAccel_noise = Moving_ObjectAccel_noise_mag * [(dt^2/2)*randn; dt*randn]; Q= A * Q+ B * u + Moving_ObjectAccel_noise; ......................... pause end %plot theoretical path of Missile_Launcher that doesn't use kalman plot(0:dt:t, smooth(Q_loc_meas), '-g.') %plot(0:dt:t, vel, '-b.') %% Do kalman filtering %initize estimation variables ......................... % Plot the results figure(2); plot(tt,Q_loc,'-r.',tt,Q_loc_meas,'-k.', tt,Q_loc_estimate,'-g.'); %data measured by the Missile_Launcher ……………………… .. %combined position estimate mu = Q_loc_estimate(T); % mean sigma = P_mag_estimate(T); % standard deviation y = normpdf(x,mu,sigma); % pdf y = y/(max(y)); hl = line(x,y, 'Color','g'); % or use hold on and normal plot axis([Q_loc_estimate(T)-5 Q_loc_estimate(T)+5 0 1]); %actual position of the Moving_Object plot(Q_loc(T)); ylim=get(gca,'ylim'); line([Q_loc(T);Q_loc(T)],ylim.','linewidth',2,'color','b'); legend('state predicted','measurement','state estimate','actual Moving_Object position') pause end