Function position_update 

pub fn position_update(
    state: &StrapdownState,
    velocity: Vector3<f64>,
    dt: f64,
) -> (f64, f64, f64)

Position update in NED

This function implements the position update equation for the strapdown navigation system. It takes the current state, the velocity vector, and the time step as inputs and returns the updated position (latitude, longitude, altitude).

Arguments

• state - A reference to the current StrapdownState containing the position and velocity.
• velocity - A Vector3 representing the velocity vector in m/s in the NED frame.
• dt - A f64 representing the time step in seconds.

Returns

• A tuple (latitude, longitude, altitude) representing the updated position in radians and meters.