94 lines
2.1 KiB
C
94 lines
2.1 KiB
C
#include <stdio.h>
|
||
#include <stdlib.h> // 包含 strtof()
|
||
#include <string.h>
|
||
#include <stdint.h>
|
||
|
||
#define START_CMD 'start()'
|
||
#define STOP_CMD 'stop()'
|
||
|
||
/**
|
||
压力
|
||
接口协议: $P=XXX.XXX空格;<回车><换行>
|
||
压力整数位部分固定三位，位数不够前面补零，小数部分固定三位；单位 dbar。
|
||
负（-）号占一位，正（+）号不显示。
|
||
例如：$P=005.000 ;
|
||
$P=-01.000 ;
|
||
注：压力小于 1000dbar，整数部分是 3 位，小数部分是 3 位；超过或等于 1000dabr，整数部分是 4 位，小数
|
||
部分是 3 位。
|
||
例如：$P=999.999；
|
||
$P=1000.000
|
||
**/
|
||
|
||
|
||
/**
|
||
* @brief 通过字符串获取压力值，单位dbar
|
||
* 1dbar=1.02m
|
||
* @param str 传入的字符串，例如"$P=6999.454 ;"
|
||
* @return dbar数值对应的深度值，单位m
|
||
* 成功返回深度值，失败返回INT16_MIN
|
||
*/
|
||
int16_t dbar2Deepth(char *str)
|
||
{
|
||
//char str[] = "$P=6999.454 ;";
|
||
char *start, *end;
|
||
float num;
|
||
int8_t err;
|
||
|
||
// 查找等号后的字符位置
|
||
start = strchr(str, '='); // 找到 '=' 的位置
|
||
if (start != NULL)
|
||
{
|
||
start++; // 跳过 '='
|
||
|
||
// 使用 strtof() 函数从字符串中提取浮点数
|
||
num = strtof(start, &end);
|
||
|
||
// 检查转换是否成功，并且确保后面是分号 ' '
|
||
if (*end == ' ')
|
||
{
|
||
printf("提取的dbar数值: %f\n", num);
|
||
err = 0;
|
||
}
|
||
else
|
||
{
|
||
err = 1;
|
||
printf("转换失败，剩余未转换的字符: %s\n", end);
|
||
}
|
||
}
|
||
else
|
||
{
|
||
err = -1;
|
||
printf("没有找到等号。\n");
|
||
}
|
||
|
||
if (err == 0 || err == 1)
|
||
{
|
||
//1dbar=1.02m
|
||
return (int16_t)(num * 1.02);
|
||
}
|
||
if (err == -1)
|
||
{
|
||
return INT16_MIN;
|
||
}
|
||
}
|
||
|
||
|
||
|
||
/**
|
||
* @brief 获取当前深度值
|
||
* 通过 dbar2Deepth() 函数将字符串 "$P=6999.454 ;" 转换为
|
||
* 压力值对应的深度值，单位m
|
||
* @return 深度值，单位m
|
||
*/
|
||
int16_t getDeepth() {
|
||
char str[] = "$P= 6999.454 ;";
|
||
return dbar2Deepth(str);
|
||
}
|
||
|
||
int main() {
|
||
// char str[] = "$P=-1999.454 ;";
|
||
|
||
|
||
printf("当前深度：%d\n", getDeepth());
|
||
}
|