#define TEMP_BUF_SIZE 255
#define MAX_VAL_LENGTH 40
-#define ACCEL_ADJUST 100000
#define ACCEL_MAX 1961330
-#define GYRO_ADJUST 17.50
-
static int parse_val(const char *buff, unsigned char data, char *parsbuf)
{
int count=0;
int accel_min_max(double value)
{
- int result = (int)(value * ACCEL_ADJUST);
+ int result = (int)value;
if (result > ACCEL_MAX)
result = ACCEL_MAX;
// x
len += get_parse_val(data + len, tmp);
- x = (int)(atoi(tmp) / GYRO_ADJUST);
+ x = (int)atoi(tmp);
// y
len += get_parse_val(data + len, tmp);
- y = (int)(atoi(tmp) / GYRO_ADJUST);
+ y = (int)atoi(tmp);
// z
len += get_parse_val(data + len, tmp);
- z = (int)(atoi(tmp) / GYRO_ADJUST);
+ z = (int)atoi(tmp);
memset(tmp, 0, TEMP_BUF_SIZE);
switch (rotation_type) {
case ROTATION_PORTRAIT:
x = 100;
- y = accel_min_max(9.80665);
+ y = accel_min_max(980665);
z = 100;
break;
case ROTATION_LANDSCAPE:
- x = accel_min_max(9.80665);
+ x = accel_min_max(980665);
y = 100;
z = 100;
break;
case ROTATION_REVERSE_PORTRAIT:
x = 100;
- y = accel_min_max(-9.80665);
+ y = accel_min_max(-980665);
z = 100;
break;
case ROTATION_REVERSE_LANDSCAPE:
- x = accel_min_max(-9.80665);
+ x = accel_min_max(-980665);
y = 100;
z = 100;
break;