shoe_sdk_c/InertialTrajProcess.h

#pragma once

#ifndef _inertialtrajprocess_h_
#define _inertialtrajprocess_h_

#include <iostream>

class InertialTrajProcess
{
	public:
		InertialTrajProcess();
		void TrajRotate(int* pos);
		void TrajRotate(int *pos, float rotateMatrix[4]);
		void ResetHeading(int heading);

	private:
		int shoesPos[3];
		float curheading;
};
#endif