Biorbd Release_1.13.0
Loading...
Searching...
No Matches
CasadiExpand.cpp
1#define BIORBD_API_EXPORTS
2#include "Utils/CasadiExpand.h"
3
4using namespace BIORBD_NAMESPACE;
5
6#ifdef USE_SMOOTH_IF_ELSE
7casadi::MX utils::lt(const casadi::MX& x, const casadi::MX& y) { return x - y; }
8
9casadi::MX utils::le(const casadi::MX& x, const casadi::MX& y) {
10 return utils::lt(x, y);
11}
12
13casadi::MX utils::gt(const casadi::MX& x, const casadi::MX& y) {
14 return utils::lt(y, x);
15}
16
17casadi::MX utils::ge(const casadi::MX& x, const casadi::MX& y) {
18 return utils::le(y, x);
19}
20
21casadi::MX utils::if_else(
22 const casadi::MX& cond,
23 const casadi::MX& if_true,
24 const casadi::MX& if_false,
25 double b) {
26 return if_true +
27 (if_false - if_true) * (0.5 + 0.5 * casadi::MX::tanh(b * cond));
28}
29
30casadi::MX utils::if_else_zero(
31 const casadi::MX& cond,
32 const casadi::MX& if_true,
33 double b) {
34 return utils::if_else(cond, if_true, 0, b);
35}
36#endif