32 lines
668 B
32 lines
668 B
import os
|
|
|
|
from cffi import FFI
|
|
from common.ffi_wrapper import suffix
|
|
|
|
mpc_dir = os.path.join(os.path.dirname(os.path.abspath(__file__)))
|
|
libmpc_fn = os.path.join(mpc_dir, "libmpc"+suffix())
|
|
|
|
ffi = FFI()
|
|
ffi.cdef("""
|
|
|
|
typedef struct {
|
|
double x_ego, v_ego, a_ego;
|
|
} state_t;
|
|
|
|
|
|
typedef struct {
|
|
double x_ego[21];
|
|
double v_ego[21];
|
|
double a_ego[21];
|
|
double t[21];
|
|
double j_ego[20];
|
|
double cost;
|
|
} log_t;
|
|
|
|
|
|
void init(double xCost, double vCost, double aCost, double accelCost, double jerkCost);
|
|
void init_with_simulation(double v_ego);
|
|
int run_mpc(state_t * x0, log_t * solution, double x_poly[4], double v_poly[4], double a_poly[4]);
|
|
""")
|
|
|
|
libmpc = ffi.dlopen(libmpc_fn)
|
|
|