#ifndef _FIX_MATH_H__
#define _FIX_MATH_H__
#include "bsp/bsp.h"
#include "os/os_types.h"
typedef signed short sfix16En10_t;
typedef signed short sfix16En6_t;
typedef signed short sfix16En5_t;
typedef signed short sfix16En4_t;

typedef int          sfix32En4_t;

#define Fix10_6(x) (x >> 4)
#define i2sFix6(x) ((sfix16En6_t)(x <<6))
#define i2sFix5(x) ((sfix16En6_t)(x <<5))
#define i2sFix4(x) ((sfix16En6_t)(x <<4))
#define i2sFix10(x) ((sfix16En6_t)(x <<10))

#define i2sFix32E4(x) ((sfix32En4_t)(x <<4))
#define sFix32E4_s16(x) ((s16)(x >> 4))

static __INLINE sfix16En10_t ftoSfix10(float v) {
	s16 num = (s16)v;
	float tail_f = v - num;
	u8 tail_u8 = (u8)(tail_f / (1.0f / 1024.0f)); 

	return (s16) ((num << 10) | (tail_u8 & 0x03FF));
}


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

static __INLINE sfix16En6_t ftoSfix6(float v) {
	s16 num = (s16)v;
	float tail_f = v - num;
	u8 tail_u8 = (u8)(tail_f / (1.0f / 64.0f)); 

	return (s16) ((num << 6) | (tail_u8 & 0x003F));
}



#endif /* _FIX_MATH_H__ */