rtsam 0.1.4

Real Time Smoothing and Mapping (RTSAM) in Rust.
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21

use nalgebra;

use nalgebra::Vector6;
use rtsam::core::group::LieGroup;
use rtsam::geometry::SE3;

fn main() -> Result<(), Box<dyn std::error::Error>> {
    println!("Dummy Example PRoGraM");

    let w = Vector6::new(1., 1.2, 1.3, 1., 1.4, 1.3);

    let exp = SE3::expmap_with_derivative(&w, None);

    let log = SE3::logmap(&exp, None);

    println!("w: {}", w.transpose());
    println!("Expmap: {}", exp);
    println!("Logmap: {}", log.transpose());

    Ok(())
}