Simulate INS Block
In this example, you simulate an INS block by using the pose information of a vehicle undertaking a left-turn trajectory.
Load Vehicle Trajectory Data
First, you load the trajectory information of the vehicle to the workspace.
You notice that seven new variables appear in MATLAB workspace.
dt— The time step size of 0.4 seconds.
t— The total time span of 7.88 seconds.
vehAngVel— The history of position, velocity, acceleration, orientation, and angular velocity, each specified as a 198-by-3 matrix, where 198 is the total number of steps.
Open Simulink Model
Next, you open the Simulink model.
The model contains three parts: the data importing part, the INS block, and the scope block to compare the true positions with the INS outputs.
The data importing part imports the vehicle trajectory data into Simulink using the From Workspace (Simulink) block. You use a helper function
helperFromWorkspace, attached in the example folder, to convert the trajectory data into a structure format required by the From Workspace block.
Run the Model
Run the Simulink model.
resulsts = sim('simulateINS');
Click on the scope block and see the results. The INS block position outputs closely follow the truth with the addition of noise.