From f618466c25d43f3bae9e40920273bf77de1e1149 Mon Sep 17 00:00:00 2001 From: leochanj105 Date: Mon, 19 Oct 2020 23:09:30 -0400 Subject: initial sd-vbs initial sd-vbs add sd-vbs sd-vbs --- .../benchmarks/localization/src/c/localization.h | 24 ++++++++++++++++++++++ 1 file changed, 24 insertions(+) create mode 100644 SD-VBS/benchmarks/localization/src/c/localization.h (limited to 'SD-VBS/benchmarks/localization/src/c/localization.h') diff --git a/SD-VBS/benchmarks/localization/src/c/localization.h b/SD-VBS/benchmarks/localization/src/c/localization.h new file mode 100644 index 0000000..b2c03bb --- /dev/null +++ b/SD-VBS/benchmarks/localization/src/c/localization.h @@ -0,0 +1,24 @@ +/******************************** +Author: Sravanthi Kota Venkata +********************************/ + +#ifndef _LOCALIZATION_ +#define _LOCALIZATION_ + +#include "sdvbs_common.h" + +int script_localization(); +F2D* eul2quat(F2D* angle); +void generateSample(F2D *w, F2D *quat, F2D *vel, F2D *pos); +F2D* get3DGaussianProb( F2D* data, F2D* mean, F2D* A); +F2D* mcl(F2D* x, F2D* sData, F2D* invConv); +F2D* quat2eul(F2D* quat); +F2D* quatConj(F2D* a); +F2D* quatMul(F2D* a, F2D* b); +F2D* quatRot(F2D* vec, F2D* rQuat); +F2D* readSensorData(I2D* index, F2D* fid, I2D* type, I2D* eof); +I2D* weightedSample(F2D* w); + +#endif + + -- cgit v1.2.2