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
69
#[derive(Debug, Clone, Fail)]
pub enum JointError {
#[fail(display = "joint: {} is out of limit: {}", joint_name, message)]
OutOfLimitError {
joint_name: String,
message: String,
},
#[fail(display = "size mismatch input = {}, required = {}", input, required)]
SizeMismatchError {
input: usize,
required: usize,
},
#[fail(display = "mimic error from {} to {}", from, to)]
MimicError {
from: String,
to: String,
message: String,
},
#[fail(display = "invalid arguments {:?}", error)]
InvalidArgumentsError { error: String },
}
#[derive(Debug, Fail)]
pub enum IKError {
#[fail(display = "ik solve not converged {:?}", error)]
NotConvergedError { error: String },
#[fail(display = "inverse matrix error")]
InverseMatrixError,
#[fail(display = "ik precondition error {:?}", error)]
PreconditionError { error: String },
#[fail(display = "joint error: {:?}", error)]
JointOutOfLimitError { error: JointError },
#[fail(display = "invalid arguments {:?}", error)]
InvalidArgumentsError { error: String },
}
impl From<JointError> for IKError {
fn from(error: JointError) -> IKError {
IKError::JointOutOfLimitError { error }
}
}