You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
30 lines
1012 B
30 lines
1012 B
#include "locationd.h"
|
|
|
|
extern "C" {
|
|
typedef Localizer* Localizer_t;
|
|
|
|
Localizer *localizer_init() {
|
|
return new Localizer();
|
|
}
|
|
|
|
void localizer_get_message_bytes(Localizer *localizer, uint64_t logMonoTime,
|
|
bool inputsOK, bool sensorsOK, bool gpsOK, char *buff, size_t buff_size)
|
|
{
|
|
MessageBuilder msg_builder;
|
|
kj::ArrayPtr<char> arr = localizer->get_message_bytes(msg_builder, logMonoTime, inputsOK, sensorsOK, gpsOK).asChars();
|
|
assert(buff_size >= arr.size());
|
|
memcpy(buff, arr.begin(), arr.size());
|
|
}
|
|
|
|
void localizer_handle_msg_bytes(Localizer *localizer, const char *data, size_t size) {
|
|
localizer->handle_msg_bytes(data, size);
|
|
}
|
|
|
|
void get_filter_internals(Localizer *localizer, double *state_buff, double *std_buff){
|
|
Eigen::VectorXd state = localizer->get_state();
|
|
memcpy(state_buff, state.data(), sizeof(double) * state.size());
|
|
Eigen::VectorXd stdev = localizer->get_stdev();
|
|
memcpy(std_buff, stdev.data(), sizeof(double) * stdev.size());
|
|
}
|
|
|
|
}
|
|
|