k 0.32.0

k is for kinematics
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68

#[cfg(target_family = "wasm")]
use wasm_bindgen_test::wasm_bindgen_test as test;

#[cfg(target_family = "wasm")]
wasm_bindgen_test::wasm_bindgen_test_configure!(run_in_browser);

#[test]
fn test_tree() {
    let tree = k::Chain::<f32>::from(
        urdf_rs::read_from_string(include_str!("../urdf/sample.urdf")).unwrap(),
    );
    assert_eq!(tree.dof(), 12);
    let all_names = tree
        .iter()
        .map(|link| link.joint().name.clone())
        .collect::<Vec<_>>();
    assert_eq!(all_names.len(), 13);
    assert_eq!(
        all_names,
        [
            "root",
            "l_shoulder_yaw",
            "l_shoulder_pitch",
            "l_shoulder_roll",
            "l_elbow_pitch",
            "l_wrist_yaw",
            "l_wrist_pitch",
            "r_shoulder_yaw",
            "r_shoulder_pitch",
            "r_shoulder_roll",
            "r_elbow_pitch",
            "r_wrist_yaw",
            "r_wrist_pitch"
        ]
    );

    let names = tree
        .iter_joints()
        .map(|j| j.name.clone())
        .collect::<Vec<_>>();
    assert_eq!(names.len(), 12);
    assert_eq!(names[0], "l_shoulder_yaw");
}

#[allow(clippy::redundant_clone)] // This is intentional.
#[test]
fn test_clone() {
    let tree = k::Chain::<f32>::from(
        urdf_rs::read_from_string(include_str!("../urdf/sample.urdf")).unwrap(),
    );
    let tree2 = tree.clone();
    assert_eq!(tree.dof(), 12);
    assert_eq!(tree2.dof(), 12);
    let pos = vec![0.0, 0.1, 0.2, 0.3, 0.4, 0.5, 0.6, 0.7, 0.8, 0.9, -0.1, -0.2];
    let pos0 = vec![0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0];
    tree.set_joint_positions(&pos).unwrap();
    assert_eq!(tree.joint_positions(), pos);
    assert_eq!(tree2.joint_positions(), pos0);
    tree2.set_joint_positions(&pos).unwrap();
    assert_eq!(tree2.joint_positions(), pos);
    assert_eq!(
        tree.iter().map(|n| n.world_transform()).collect::<Vec<_>>(),
        tree2
            .iter()
            .map(|n| n.world_transform())
            .collect::<Vec<_>>()
    );
}