MC100/Applications/libs/utils.h

#ifndef _UTILS_H__
#define _UTILS_H__

#include "os/os_type.h"
#include "os/co_task.h"

#define delay_us cpu_udelay

static __inline__ void delay_ms(u32 ms) {
	cpu_udelay(ms*1000);
}

static __inline__ u8 decode_u8(u8 *buff) {
	return buff[0];
}

static __inline__ u16 decode_u16(u8 *buff) {
	return (((u16)(buff[1]) << 8) | buff[0]);
}

static __inline__ u32 decode_u24(u8 *buff) {
	return ((u32)(buff[2]) << 16 | decode_u16(buff));
}

static __inline__ u16 decode_u32(u8 *buff) {
	return ((u32)(buff[3]) << 24 | decode_u24(buff));
}

static __inline__ void encode_u16(u8 *buff, u16 value)
{
	buff[0] = value;
	buff[1] = value >> 8;
}

static __inline__ void encode_u24(u8 *buff, u32 value)
{
	encode_u16(buff, value);
	buff[2] = value >> 16;
}

static __inline__ void encode_u32(u8 *buff, u32 value)
{
	encode_u24(buff, value);
	buff[3] = value >> 24;
}


static __inline__ s8 decode_s08(const u8 *buff)
{
	return ((s8) buff[0]);
}

static __inline__ s16 decode_s16(const u8 *buff)
{
	return ((s16) buff[1]) << 8 | buff[0];
}

static __inline__ s32 decode_s24(const u8 *buff)
{
	return ((s32) buff[2]) << 16 | decode_s16(buff);
}

static __inline__ s32 decode_s32(const u8 *buff)
{
	return ((s32) buff[3]) << 24 | decode_s24(buff);
}

static __inline__ void encode_s08(u8 *buff, s8 value)
{
	buff[0] = value;
}

static __inline__ void encode_s16(u8 *buff, s16 value)
{
	encode_s08(buff,value);
	encode_s08(buff+1,value >> 8);

}

static __inline__ void encode_s24(u8 *buff, s32 value)
{
	encode_s16(buff, value);
	encode_s08(buff+2,value >> 16);
}

static __inline__ void encode_s32(u8 *buff, s32 value)
{
	encode_s24(buff, value);
	encode_s08(buff+3,value >> 24);
}


#define ARRAY_SIZE(a) (sizeof(a)/sizeof(a[0]))
#define min(a,b) (a>b?b:a)
#define MAX(x, y) ((x)>(y)?(x):(y))


#endif /* _UTILS_H__ */