94 lines
2.0 KiB
C
94 lines
2.0 KiB
C
|
#include "jt808_util.h"
|
|||
|
|
#include "jt808_config.h"
|
|||
|
|
|
|||
|
|
// 双字节大小端转换
|
|||
|
|
uint16_t Swap16(uint16_t val16){
|
|||
|
|
return (((val16 & 0x00FF) << 8) |
|
|||
|
|
((val16 & 0xFF00) >> 8));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 四字节大小端转换
|
|||
|
|
uint32_t Swap32(uint32_t val32){
|
|||
|
|
return (((val32 & 0x000000FF) << 24) |
|
|||
|
|
((val32 & 0x0000FF00) << 8) |
|
|||
|
|
((val32 & 0x00FF0000) >> 8) |
|
|||
|
|
((val32 & 0xFF000000) >> 24));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 异或校验
|
|||
|
|
uint8_t BCC_Check(const uint8_t *src, uint32_t len)
|
|||
|
|
{
|
|||
|
|
uint8_t bcc_check = 0;
|
|||
|
|
for(uint32_t i = 0; i < len; ++i){
|
|||
|
|
bcc_check ^= src[i];
|
|||
|
|
}
|
|||
|
|
return bcc_check;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 十进制转BCD码
|
|||
|
|
uint8_t DecToBcd(uint8_t Dec){
|
|||
|
|
uint8_t temp;
|
|||
|
|
temp = ((Dec / 10) << 4) + (Dec % 10);
|
|||
|
|
return temp;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// BCD码转十进制
|
|||
|
|
uint8_t BcdToDec(uint8_t Bcd){
|
|||
|
|
uint8_t temp;
|
|||
|
|
temp = (Bcd >> 4) * 10 + (Bcd & 0x0f);
|
|||
|
|
return temp;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 原始字符串转BCD码 //奇数位时，首位BCD码前面补0
|
|||
|
|
uint8_t *rawStrToBcd(uint8_t *bcd, const uint8_t *str, uint16_t str_len){
|
|||
|
|
uint8_t *ptr = bcd;
|
|||
|
|
uint8_t temp;
|
|||
|
|
if (str_len % 2 != 0){
|
|||
|
|
*ptr++ = DecToBcd(*str++ - '0');
|
|||
|
|
}
|
|||
|
|
while (*str){
|
|||
|
|
temp = *str++ - '0';
|
|||
|
|
temp *= 10;
|
|||
|
|
temp += *str++ - '0';
|
|||
|
|
*ptr++ = DecToBcd(temp);
|
|||
|
|
}
|
|||
|
|
return bcd;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// BCD转字符串，自动去掉bcd码前导零
|
|||
|
|
// bcdlen 为bcd码字节数
|
|||
|
|
uint8_t *BcdToStr(uint8_t *str, const uint8_t *bcd, int bcd_len){
|
|||
|
|
uint8_t *ptr = str;
|
|||
|
|
uint8_t temp;
|
|||
|
|
int cnt = bcd_len;
|
|||
|
|
while (cnt--){
|
|||
|
|
temp = BcdToDec(*bcd);
|
|||
|
|
*ptr++ = temp / 10 + '0';
|
|||
|
|
if(str[0] == '0'){
|
|||
|
|
ptr = str;
|
|||
|
|
}
|
|||
|
|
*ptr++ = temp % 10 + '0';
|
|||
|
|
if(str[0] == '0'){
|
|||
|
|
ptr = str;
|
|||
|
|
}
|
|||
|
|
++bcd;
|
|||
|
|
}
|
|||
|
|
return str;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// 原始BCD数据转字符串
|
|||
|
|
// strlen 为原始BCD数据字节数
|
|||
|
|
uint8_t *rawBcdToStr(uint8_t *str, const uint8_t *bcd, int bcd_len){
|
|||
|
|
uint8_t *ptr = str;
|
|||
|
|
uint8_t temp;
|
|||
|
|
int cnt = bcd_len;
|
|||
|
|
while (cnt--)
|
|||
|
|
{
|
|||
|
|
temp = BcdToDec(*bcd);
|
|||
|
|
*ptr++ = temp / 10 + '0';
|
|||
|
|
*ptr++ = temp % 10 + '0';
|
|||
|
|
++bcd;
|
|||
|
|
}
|
|||
|
|
return str;
|
|||
|
|
}
|