Skip to main content

SRUKFLocalizer

Struct SRUKFLocalizer 

Source
pub struct SRUKFLocalizer { /* private fields */ }
Expand description

Square Root Unscented Kalman Filter localizer.

Implementations§

Source§

impl SRUKFLocalizer

Source

pub fn new(config: SRUKFConfig) -> Self

Create a new SR-UKF localizer.

Source

pub fn try_new(config: SRUKFConfig) -> RoboticsResult<Self>

Create a validated SR-UKF localizer.

Source

pub fn with_initial_state(state: SRUKFState, config: SRUKFConfig) -> Self

Create with an initial state.

Source

pub fn state_2d(&self) -> State2D

Return the current estimate as State2D.

Trait Implementations§

Source§

impl StateEstimator for SRUKFLocalizer

Source§

type State = Matrix<f64, Const<4>, Const<1>, ArrayStorage<f64, 4, 1>>

State type used by this estimator
Source§

type Measurement = Matrix<f64, Const<2>, Const<1>, ArrayStorage<f64, 2, 1>>

Measurement type used by this estimator
Source§

type Control = Matrix<f64, Const<2>, Const<1>, ArrayStorage<f64, 2, 1>>

Control input type
Source§

fn predict(&mut self, control: &Self::Control, dt: f64)

Prediction step
Source§

fn update(&mut self, measurement: &Self::Measurement)

Update step with measurement
Source§

fn get_state(&self) -> &Self::State

Get current state estimate
Source§

fn get_covariance(&self) -> Option<&DMatrix<f64>>

Get current covariance estimate (if applicable)

Auto Trait Implementations§

Blanket Implementations§

Source§

impl<T> Any for T
where T: 'static + ?Sized,

Source§

fn type_id(&self) -> TypeId

Gets the TypeId of self. Read more
Source§

impl<T> Borrow<T> for T
where T: ?Sized,

Source§

fn borrow(&self) -> &T

Immutably borrows from an owned value. Read more
Source§

impl<T> BorrowMut<T> for T
where T: ?Sized,

Source§

fn borrow_mut(&mut self) -> &mut T

Mutably borrows from an owned value. Read more
Source§

impl<T> From<T> for T

Source§

fn from(t: T) -> T

Returns the argument unchanged.

Source§

impl<T, U> Into<U> for T
where U: From<T>,

Source§

fn into(self) -> U

Calls U::from(self).

That is, this conversion is whatever the implementation of From<T> for U chooses to do.

Source§

impl<T> Same for T

Source§

type Output = T

Should always be Self
§

impl<SS, SP> SupersetOf<SS> for SP
where SS: SubsetOf<SP>,

§

fn to_subset(&self) -> Option<SS>

The inverse inclusion map: attempts to construct self from the equivalent element of its superset. Read more
§

fn is_in_subset(&self) -> bool

Checks if self is actually part of its subset T (and can be converted to it).
§

fn to_subset_unchecked(&self) -> SS

Use with care! Same as self.to_subset but without any property checks. Always succeeds.
§

fn from_subset(element: &SS) -> SP

The inclusion map: converts self to the equivalent element of its superset.
Source§

impl<T, U> TryFrom<U> for T
where U: Into<T>,

Source§

type Error = Infallible

The type returned in the event of a conversion error.
Source§

fn try_from(value: U) -> Result<T, <T as TryFrom<U>>::Error>

Performs the conversion.
Source§

impl<T, U> TryInto<U> for T
where U: TryFrom<T>,

Source§

type Error = <U as TryFrom<T>>::Error

The type returned in the event of a conversion error.
Source§

fn try_into(self) -> Result<U, <U as TryFrom<T>>::Error>

Performs the conversion.
§

impl<V, T> VZip<V> for T
where V: MultiLane<T>,

§

fn vzip(self) -> V