#ifndef _FIX_MATH_H__
#define _FIX_MATH_H__
#include "bsp/bsp.h"
#include "os/os_types.h"
typedef signed short sfix10_t;
typedef signed short sfix6_t;

#define _F2sFix10(x) (sfix10_t)(x * 1024.0f)
#define _F2sFix6(x)  (sfix6_t)(x * 64.0f)

#define Fix10_6(x) (x >> 4)

static __INLINE float sfix6toF(sfix6_t v) {
	s16 num = (v >> 6) & 0xFFFF;
	u16 tail = v & 0x003F;
	float f = num + (float)tail / 64.0f;
	return f;
} 

#endif /* _FIX_MATH_H__ */