mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-02-19 18:13:55 +08:00
f4e94524d4
* cleaning crew
* need that to match
* smooth factor
* that didn't really work
* closer to previous
* new ref
* new names
old-commit-hash: 61a4e3e661
33 lines
793 B
Python
33 lines
793 B
Python
import os
|
|
|
|
from cffi import FFI
|
|
from common.ffi_wrapper import suffix
|
|
|
|
mpc_dir = os.path.dirname(os.path.abspath(__file__))
|
|
libmpc_fn = os.path.join(mpc_dir, "libmpc"+suffix())
|
|
|
|
ffi = FFI()
|
|
ffi.cdef("""
|
|
typedef struct {
|
|
double x, y, psi, curvature, curvature_rate;
|
|
} state_t;
|
|
int N = 16;
|
|
|
|
typedef struct {
|
|
double x[N+1];
|
|
double y[N+1];
|
|
double psi[N+1];
|
|
double curvature[N+1];
|
|
double curvature_rate[N];
|
|
double cost;
|
|
} log_t;
|
|
|
|
void init(double pathCost, double headingCost, double steerRateCost);
|
|
void init_weights(double pathCost, double headingCost, double steerRateCost);
|
|
int run_mpc(state_t * x0, log_t * solution,
|
|
double v_ego, double rotation_radius,
|
|
double target_y[N+1], double target_psi[N+1]);
|
|
""")
|
|
|
|
libmpc = ffi.dlopen(libmpc_fn)
|