kcan 0.1.2

CAN controller primitives for actuator and motor control.
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

use kcan::protocols::robstride::{
    RobStrideCommand, RobStrideMitCommand, RobStrideModel, RobStridePositionCommand,
    RobStrideSpeedCommand, robstride_command_frame, robstride_status_query_frame,
};

fn main() -> Result<(), kcan::Error> {
    let model = RobStrideModel::Rs01;
    let motor_id = 0x01;
    let frames = [
        ("status", robstride_status_query_frame(motor_id)?),
        (
            "mit",
            robstride_command_frame(
                model,
                motor_id,
                RobStrideCommand::Mit(RobStrideMitCommand {
                    position_rad: 0.25,
                    velocity_rad_s: 0.05,
                    kp: 20.0,
                    kd: 0.4,
                    torque_nm: 0.5,
                }),
            )?,
        ),
        (
            "position",
            robstride_command_frame(
                model,
                motor_id,
                RobStrideCommand::Position(RobStridePositionCommand {
                    position_rad: 0.5,
                    velocity_rad_s: 0.1,
                    max_torque_nm: 3.0,
                }),
            )?,
        ),
        (
            "speed",
            robstride_command_frame(
                model,
                motor_id,
                RobStrideCommand::Speed(RobStrideSpeedCommand {
                    velocity_rad_s: 0.2,
                    max_torque_nm: 2.0,
                }),
            )?,
        ),
    ];

    for (name, frame) in frames {
        println!(
            "{name:<8} id={:?} len={} data={}",
            frame.id(),
            frame.len(),
            hex(frame.data())
        );
    }

    Ok(())
}

fn hex(data: &[u8]) -> String {
    data.iter()
        .map(|byte| format!("{byte:02X}"))
        .collect::<Vec<_>>()
        .join(" ")
}