franka_rust 0.1.14

Rust bindings for the Franka Emika Panda robot
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

use std::f64::consts::{FRAC_PI_2, FRAC_PI_4};

use robot_behavior::{DhParam, behavior::*};

use crate::{FRANKA_DOF, FrankaRobot, robot::FrankaType};

#[derive(Default)]
pub struct _FrankaEmika;

impl FrankaType for _FrankaEmika {}

pub type FrankaEmika = FrankaRobot<_FrankaEmika>;

impl ArmParam<FRANKA_DOF> for _FrankaEmika {
    const JOINT_DEFAULT: [f64; FRANKA_DOF] = [
        0.,
        -FRAC_PI_4,
        0.,
        -3. * FRAC_PI_4,
        0.,
        FRAC_PI_2,
        FRAC_PI_4,
    ];
    const JOINT_MIN: [f64; FRANKA_DOF] = [
        -2.8973, -1.7628, -2.8973, -3.0718, -2.8973, -0.0175, -2.8973,
    ];
    const JOINT_MAX: [f64; FRANKA_DOF] = [2.8973, 1.7628, 2.8973, -0.0698, 2.8973, 3.7525, 2.8973];
    const JOINT_VEL_BOUND: [f64; FRANKA_DOF] =
        [2.1750, 2.1750, 2.1750, 2.1750, 2.6100, 2.6100, 2.6100];
    const JOINT_ACC_BOUND: [f64; FRANKA_DOF] = [15., 7.5, 10., 12.5, 15., 20., 20.];
    const JOINT_JERK_BOUND: [f64; FRANKA_DOF] = [7500., 3750., 5000., 6250., 7500., 10000., 10000.];
    const CARTESIAN_VEL_BOUND: f64 = 1.7;
    const CARTESIAN_ACC_BOUND: f64 = 13.0;
    const CARTESIAN_JERK_BOUND: f64 = 6500.0;
    const ROTATION_VEL_BOUND: f64 = 2.5;
    const ROTATION_ACC_BOUND: f64 = 25.0;
    const ROTATION_JERK_BOUND: f64 = 12500.;
    const TORQUE_BOUND: [f64; FRANKA_DOF] = [87., 87., 87., 87., 12., 12., 12.];
    const TORQUE_DOT_BOUND: [f64; FRANKA_DOF] = [1000., 1000., 1000., 1000., 1000., 1000., 1000.];
}

impl ArmForwardKinematics<FRANKA_DOF> for FrankaEmika {
    const DH: [DhParam; FRANKA_DOF] = [
        DhParam::MDH { alpha: 0., a: 0., theta: 0., d: 0.333 },
        DhParam::MDH { alpha: -FRAC_PI_2, a: 0., theta: 0., d: 0. },
        DhParam::MDH { alpha: FRAC_PI_2, a: 0., theta: 0., d: 0.316 },
        DhParam::MDH { alpha: FRAC_PI_2, a: 0.0825, theta: 0., d: 0. },
        DhParam::MDH { alpha: -FRAC_PI_2, a: -0.0825, theta: 0., d: 0.384 },
        DhParam::MDH { alpha: FRAC_PI_2, a: 0., theta: 0., d: 0. },
        DhParam::MDH { alpha: FRAC_PI_2, a: 0.088, theta: 0., d: 0. },
    ];
}

impl RobotFile for FrankaEmika {
    const URDF: &'static str = "franka_panda/panda.urdf";
}