Lodestar
An integrated real-time control package in C++
TadpoleDemo.hpp
1 //
2 // Created by Hamza El-Kebir on 12/30/2021.
3 //
4 
5 #ifndef LODESTAR_TADPOLEDEMO_HPP
6 #define LODESTAR_TADPOLEDEMO_HPP
7 
8 
9 #include <Eigen/Dense>
10 #include <cmath>
11 
21 // Function automatically generated by Lodestar
22 Eigen::Matrix<double, 3, 3>
23 tadpoleJacStates(const Eigen::Matrix<double, 3, 1> &x, const Eigen::Matrix<double, 2, 1> &u, const double t = 0)
24 {
25  Eigen::Matrix<double, 3, 3> mat;
26  mat << 0.0, 0.0, -1.7500000000000002e-02 * sin(x[2]) * (u[0] + u[1]),
27  0.0, 0.0, 1.7500000000000002e-02 * cos(x[2]) * (u[0] + u[1]),
28  0.0, 0.0, 0.0;
29 
30  return mat;
31 }
32 
33 
43 // Function automatically generated by Lodestar
44 Eigen::Matrix<double, 3, 2>
45 tadpoleJacInput(const Eigen::Matrix<double, 3, 1> &x, const Eigen::Matrix<double, 2, 1> &u, const double t = 0)
46 {
47  Eigen::Matrix<double, 3, 2> mat;
48  mat << 1.7500000000000002e-02 * cos(x[2]), 1.7500000000000002e-02 * cos(x[2]),
49  1.7500000000000002e-02 * sin(x[2]), 1.7500000000000002e-02 * sin(x[2]),
50  -2.3625000000000005e-03, 2.3625000000000005e-03;
51 
52  return mat;
53 }
54 
55 
56 #endif //LODESTAR_TADPOLEDEMO_HPP