You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
58 lines
1.0 KiB
58 lines
1.0 KiB
/** |
|
* @copyright Copyright (c) 2021 Sagetech, Inc. All rights reserved. |
|
* |
|
* @file toGS.c |
|
* @author Jacob.Garrison |
|
* |
|
* @date Mar 2, 2021 |
|
* |
|
*/ |
|
|
|
#include "sgUtil.h" |
|
|
|
/* |
|
* Documented in the header file. |
|
*/ |
|
uint8_t toGS(const uint8_t bytes[]) |
|
{ |
|
uint8_t code = bytes[0]; |
|
float gs = 0.0f; |
|
|
|
if (code <= 0x01) |
|
{ |
|
gs = 0.0f; |
|
} |
|
else if (code <= 0x08) |
|
{ |
|
gs = 1.0f; |
|
} |
|
else if (code <= 0x0C) |
|
{ |
|
gs = 1.0f + (code - 0x09) * 0.25f; |
|
} |
|
else if (code <= 0x26) |
|
{ |
|
gs = 2.0f + (code - 0x0D) * 0.5f; |
|
} |
|
else if (code <= 0x5D) |
|
{ |
|
gs = 15.0f + (code - 0x27) * 1.0f; |
|
} |
|
else if (code <= 0x6C) |
|
{ |
|
gs = 70.0f + (code - 0x5E) * 2.0f; |
|
} |
|
else if (code <= 0x7B) |
|
{ |
|
gs = 100.0f + (code - 0x6D) * 5.0f; |
|
} |
|
else |
|
{ |
|
gs = 176.0f; |
|
} |
|
|
|
// first converting to an 16 bit integer is necessary |
|
// to keep the floating point conversion from |
|
// truncating to 0. |
|
return (uint8_t)((int16_t)gs & 0xFF); |
|
}
|
|
|