|
Robotics Library
0.6.2
|
Go to the documentation of this file.
27 #ifndef _RL_MATH_QUINTIC_H_
28 #define _RL_MATH_QUINTIC_H_
39 template<
typename T >
46 te(::std::numeric_limits<
Real>::max()),
66 return 2 *
c2 + 6 *
c3 * t + 12 *
c4 * ::std::pow(t, 2) + 20 *
c5 * ::std::pow(t, 3);
74 c3 = -(3 * ::std::pow(
te, 2) *
a0 + 12 *
te *
v0 - ::std::pow(
te, 2) *
ae + 20 *
x0 + 8 *
te *
ve - 20 *
xe) / (2 * ::std::pow(
te, 3));
75 c4 = (16 *
te *
v0 - 2 * ::std::pow(
te, 2) *
ae + 30 *
x0 + 14 *
te *
ve - 30 *
xe + 3 * ::std::pow(
te, 2) *
a0) / (2 * ::std::pow(
te, 4));
76 c5 = -(12 *
x0 + 6 *
te *
v0 + 6 *
te *
ve - 12 *
xe + ::std::pow(
te, 2) *
a0 - ::std::pow(
te, 2) *
ae) / (2 * ::std::pow(
te, 5));
81 return 6 *
c3 + 24 *
c4 * t + 60 *
c5 * ::std::pow(t, 2);
86 return c1 + 2 *
c2 * t + 3 *
c3 * ::std::pow(t, 2) + 4 *
c4 * ::std::pow(t, 3) + 5 *
c5 * ::std::pow(t, 4);
91 return c0 +
c1 * t +
c2 * ::std::pow(t, 2) +
c3 * ::std::pow(t, 3) +
c4 * ::std::pow(t, 4) +
c5 * ::std::pow(t, 5);
126 #endif // _RL_MATH_QUINTIC_H_
T xe
Definition: Quintic.h:102
Real te
Definition: Quintic.h:98
T v(const Real &t) const
Definition: Quintic.h:84
T c3
Definition: Quintic.h:117
T c4
Definition: Quintic.h:119
T x0
Definition: Quintic.h:100
T c0
Definition: Quintic.h:111
void interpolate()
Definition: Quintic.h:69
T c1
Definition: Quintic.h:113
virtual ~Quintic()
Definition: Quintic.h:60
T c2
Definition: Quintic.h:115
T ve
Definition: Quintic.h:106
T a0
Definition: Quintic.h:94
T j(const Real &t) const
Definition: Quintic.h:79
Quintic()
Definition: Quintic.h:43
T a(const Real &t) const
Definition: Quintic.h:64
T c5
Definition: Quintic.h:121
T ae
Definition: Quintic.h:96
T v0
Definition: Quintic.h:104
T x(const Real &t) const
Definition: Quintic.h:89
double Real
Definition: Real.h:34