106 lines
2.6 KiB
C
106 lines
2.6 KiB
C
|
/*
|
||
|
|
** serial-util.h
|
||
|
|
**
|
||
|
|
** This file is part of mkxp.
|
||
|
|
**
|
||
|
|
** Copyright (C) 2013 Jonas Kulla <Nyocurio@gmail.com>
|
||
|
|
**
|
||
|
|
** mkxp is free software: you can redistribute it and/or modify
|
||
|
|
** it under the terms of the GNU General Public License as published by
|
||
|
|
** the Free Software Foundation, either version 2 of the License, or
|
||
|
|
** (at your option) any later version.
|
||
|
|
**
|
||
|
|
** mkxp is distributed in the hope that it will be useful,
|
||
|
|
** but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
** GNU General Public License for more details.
|
||
|
|
**
|
||
|
|
** You should have received a copy of the GNU General Public License
|
||
|
|
** along with mkxp. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#ifndef SERIALUTIL_H
|
||
|
|
#define SERIALUTIL_H
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
|
||
|
|
typedef unsigned uint;
|
||
|
|
|
||
|
|
static inline int16_t
|
||
|
|
read_int16(const char *data, uint &i)
|
||
|
|
{
|
||
|
|
int16_t result = (data[i] & 0x000000FF) | ((data[i+1] << 8) & 0x0000FF00);
|
||
|
|
i += 2;
|
||
|
|
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline int32_t
|
||
|
|
read_int32(const char *data, uint &i)
|
||
|
|
{
|
||
|
|
int32_t result = ((data[i+0] << 0x00) & 0x000000FF)
|
||
|
|
| ((data[i+1] << 0x08) & 0x0000FF00)
|
||
|
|
| ((data[i+2] << 0x10) & 0x00FF0000)
|
||
|
|
| ((data[i+3] << 0x18) & 0xFF000000);
|
||
|
|
i += 4;
|
||
|
|
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void
|
||
|
|
write_int16(char **data, int16_t value)
|
||
|
|
{
|
||
|
|
*(*data)++ = (value >> 0) & 0xFF;
|
||
|
|
*(*data)++ = (value >> 8) & 0xFF;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void
|
||
|
|
write_int32(char **data, int32_t value)
|
||
|
|
{
|
||
|
|
*(*data)++ = (value >> 0x00) & 0xFF;
|
||
|
|
*(*data)++ = (value >> 0x08) & 0xFF;
|
||
|
|
*(*data)++ = (value >> 0x10) & 0xFF;
|
||
|
|
*(*data)++ = (value >> 0x18) & 0xFF;
|
||
|
|
}
|
||
|
|
|
||
|
|
union doubleInt
|
||
|
|
{
|
||
|
|
double d;
|
||
|
|
int64_t i;
|
||
|
|
};
|
||
|
|
|
||
|
|
static inline void
|
||
|
|
write_double(char **data, double value)
|
||
|
|
{
|
||
|
|
doubleInt di;
|
||
|
|
di.d = value;
|
||
|
|
|
||
|
|
*(*data)++ = (di.i >> 0x00) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x08) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x10) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x18) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x20) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x28) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x30) & 0xFF;
|
||
|
|
*(*data)++ = (di.i >> 0x38) & 0xFF;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline double
|
||
|
|
read_double(const char *data, uint &i)
|
||
|
|
{
|
||
|
|
doubleInt di;
|
||
|
|
di.i = (((int64_t)data[i+0] << 0x00) & 0x00000000000000FF)
|
||
|
|
| (((int64_t)data[i+1] << 0x08) & 0x000000000000FF00)
|
||
|
|
| (((int64_t)data[i+2] << 0x10) & 0x0000000000FF0000)
|
||
|
|
| (((int64_t)data[i+3] << 0x18) & 0x00000000FF000000)
|
||
|
|
| (((int64_t)data[i+4] << 0x20) & 0x000000FF00000000)
|
||
|
|
| (((int64_t)data[i+5] << 0x28) & 0x0000FF0000000000)
|
||
|
|
| (((int64_t)data[i+6] << 0x30) & 0x00FF000000000000)
|
||
|
|
| (((int64_t)data[i+7] << 0x38) & 0xFF00000000000000);
|
||
|
|
i += 8;
|
||
|
|
|
||
|
|
return di.d;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif // SERIALUTIL_H
|