Added convenience constructor for Rot3
parent
7212d65d8c
commit
ff0cb3eafb
|
|
@ -78,6 +78,10 @@ namespace gtsam {
|
||||||
static Rot3 Ry(double t);
|
static Rot3 Ry(double t);
|
||||||
static Rot3 Rz(double t);
|
static Rot3 Rz(double t);
|
||||||
static Rot3 RzRyRx(double x, double y, double z);
|
static Rot3 RzRyRx(double x, double y, double z);
|
||||||
|
inline static Rot3 RzRyRx(const Vector& xyz) {
|
||||||
|
assert(xyz.size() == 3);
|
||||||
|
return RzRyRx(xyz(0), xyz(1), xyz(2));
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Tait-Bryan system from Spatial Reference Model (SRM) (x,y,z) = (roll,pitch,yaw)
|
* Tait-Bryan system from Spatial Reference Model (SRM) (x,y,z) = (roll,pitch,yaw)
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue