BWS2000倾角传感器c++测试代码_时间延迟与时间同步问题【3】

2023-12-22 18:44
文章标签 c++ 问题 时间 传感器 同步 测试代码 时间延迟 倾角 bws2000

本文主要是介绍BWS2000倾角传感器c++测试代码_时间延迟与时间同步问题【3】，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

详见昨天做的测试代码，代码网址：
BWS2000倾角传感器c++测试代码【2】-CSDN博客文章浏览阅读268次，点赞7次，收藏8次。倾角传感器测试与编写思路https://blog.csdn.net/m0_47489229/article/details/135128748

问题一：新的问题出现---存在时间延缓的问题

昨天的代码今天打开之后，再进行测试出现了一个问题，就是当移动倾角传感器之后，可以见到传感器显示的数值变化是比实际慢很多的，可以明显看出来。

由于昨天的代码存在相应的时间延迟，不方便后面进行传感器的时间同步。我的思路是搞个多线程

由于倾角传感器存在时间延迟的问题，但是厂家给出的软件之中并不存在时间延迟的问题。所以为了解决这个问题我的想法是创建一个线程，进行实时处理传输的接口信息，对于通信接口进行连接判断。连接的瞬间就进行数据处理。

写个测试案例：
首先创建一个线程，实时监督接口与进行数据处理：


void sensorThread()
{std::cout << " " << std::endl;std::cout << "开始采集 " << std::endl;int i = 0;while (1){ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL);auto startTime = std::chrono::high_resolution_clock::now();for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}bool flag1 = false;int flag;for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 1] == 0x10 && dataReceived[i + 2] == 0x00 && dataReceived[i + 3] == 0xFFFFFF84){flag1 = true;flag = i;break;}}std::cout << "" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(4000));if (flag1 == true){//x轴// Given hexadecimal valuesint hexValues[] = { dataReceived[flag + 5] & 0xFF, dataReceived[flag + 6] & 0xFF, dataReceived[flag + 7] & 0xFF };int hexValues1[] = { dataReceived[flag + 9] & 0xFF, dataReceived[flag + 10] & 0xFF, dataReceived[flag + 11] & 0xFF };int numValues = sizeof(hexValues) / sizeof(hexValues[0]);std::stringstream ss;ss << std::setfill('0') << std::setw(2) << std::hex << hexValues[0];for (int i = 1; i < numValues; i++) {ss << "." << std::setw(2) << std::hex << hexValues[i];}std::string resultString = ss.str();std::string inputString = resultString;std::string outputString;size_t firstDotIndex = inputString.find('.');size_t secondDotIndex = inputString.find('.', firstDotIndex + 1);if (firstDotIndex != std::string::npos && secondDotIndex != std::string::npos) {outputString = inputString.substr(0, secondDotIndex) + inputString.substr(secondDotIndex + 1);}else {outputString = inputString;}double resultDouble = std::stod(outputString);if (dataReceived[flag + 4] == 0x00){Sensor_Angle_RX0 = resultDouble;}else{Sensor_Angle_RX0 = -resultDouble;}std::cout << "x轴角度" << Sensor_Angle_RX0 << std::endl;//Y轴int numValues1 = sizeof(hexValues1) / sizeof(hexValues1[0]);std::stringstream ss1;ss1 << std::setfill('0') << std::setw(2) << std::hex << hexValues1[0];for (int i = 1; i < numValues1; i++) {ss1 << "." << std::setw(2) << std::hex << hexValues1[i];}std::string resultString1 = ss1.str();std::string inputString1 = resultString1;std::string outputString1;size_t firstDotIndex1 = inputString1.find('.');size_t secondDotIndex1 = inputString1.find('.', firstDotIndex1 + 1);if (firstDotIndex1 != std::string::npos && secondDotIndex1 != std::string::npos) {outputString1 = inputString1.substr(0, secondDotIndex1) + inputString1.substr(secondDotIndex1 + 1);}else {outputString1 = inputString1;}double resultDouble1 = std::stod(outputString1);if (dataReceived[flag + 8] == 0x00){Sensor_Angle_RY0 = resultDouble1;}else{Sensor_Angle_RY0 = -resultDouble1;}std::cout << "y轴: " << Sensor_Angle_RY0 << std::endl;// 计算执行代码所花费的时间auto endTime = std::chrono::high_resolution_clock::now();auto duration = std::chrono::duration_cast<std::chrono::milliseconds>(endTime - startTime);// 计算需要延迟的时间int delay = interval - duration.count();//std::cout << delay << std::endl;if (delay == interval){std::cout << "频率正确" << std::endl;}else if (delay > 0) {// 延迟执行std::this_thread::sleep_for(std::chrono::milliseconds(delay));std::cout << "频率正确" << std::endl;}else if (delay < 0){std::cout << "时间不够：（ms）***************************************：" << delay << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(200000000));}}}//std::this_thread::sleep_for(std::chrono::milliseconds(2000));}

在主函数函数之中对于接口进行初步的数据处理：


int main()
{// 创建传感器数据读取线程std::thread sensorThreadObj(sensorThread);//CString str123 = strValue1;//CString strA("COM10");//CString strB("\\\\.\\");//strB += strA;//const char* portName = strB.GetString();//strB.ReleaseBuffer();//strA.ReleaseBuffer();wchar_t portName[] = L"\\\\.\\COM10"; // Note the 'L' before the stringhSerial = CreateFile("\\\\.\\COM10", GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL);if (hSerial == INVALID_HANDLE_VALUE) {if (GetLastError() == ERROR_FILE_NOT_FOUND) {std::cout << "Serial port not available." << std::endl;}return 1;}dcbSerialParams.DCBlength = sizeof(dcbSerialParams);if (!GetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error getting serial port state." << std::endl;CloseHandle(hSerial);return 1;}dcbSerialParams.BaudRate = CBR_9600;dcbSerialParams.ByteSize = 8;dcbSerialParams.StopBits = ONESTOPBIT;dcbSerialParams.Parity = NOPARITY;if (!SetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial);return 1;}timeouts.ReadIntervalTimeout = 500;timeouts.ReadTotalTimeoutConstant = 500;timeouts.ReadTotalTimeoutMultiplier = 100;timeouts.WriteTotalTimeoutConstant = 500;timeouts.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial, &timeouts)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial);return 1;}//默认为9600的时候，进行对话模式char command_R4[] = { 0x77, 0x05, 0x00, 0x0C, 0x00, 0x11 };if (!WriteFile(hSerial, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "第一次9600的对话模式配置失败" << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "第一次9600的对话模式数据读取失败." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "第一次初始波特率:" << dcbSerialParams.BaudRate << std::endl;for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}bool exists = false; // 标志位，记录元素是否存在int falsecount = 0;// 循环遍历数组while (!exists) {for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 3] == 0xFFFFFF8C) {exists = true; // 元素存在，设置标志位为truestd::cout << falsecount << std::endl;std::cout << "应答模式配置成功！" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(400000));break; // 跳出for循环}}if (exists){break;}if (!exists) {falsecount++;if (falsecount >= 2)//说明原有配置是115200波特率{dcbSerialParams.BaudRate = CBR_115200;dcbSerialParams.ByteSize = 8;dcbSerialParams.StopBits = ONESTOPBIT;dcbSerialParams.Parity = NOPARITY;if (!SetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial);return 1;}timeouts.ReadIntervalTimeout = 500;timeouts.ReadTotalTimeoutConstant = 500;timeouts.ReadTotalTimeoutMultiplier = 100;timeouts.WriteTotalTimeoutConstant = 500;timeouts.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial, &timeouts)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial);return 1;}}if (!WriteFile(hSerial, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "115200的对话模式配置失败." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "115200的对话模式回复失败." << std::endl;CloseHandle(hSerial);return 1;}}}//设置频率为115200char command_R1[] = { 0x77, 0x05, 0x00, 0x0B, 0x04, 0x14 };//115200 if (!WriteFile(hSerial, command_R1, sizeof(command_R1), &bytesWritten1, NULL)){std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)){std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}exists = false;while (!exists){for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 3] == 0xFFFFFF8B) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "115200波特率配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial, command_R1, sizeof(command_R1), &bytesWritten1, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "重复配置115200波特率" << std::endl;// 可以在这里添加需要执行的语句std::this_thread::sleep_for(std::chrono::milliseconds(4000));}}//00-11:应答模式 05-50Hz 04-25Hz//06-100     05-50     04-25    char command_R3[] = { 0x77, 0x05, 0x00, 0x0C, 0x03, 0x14 };//50Hzif (!WriteFile(hSerial, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}exists = false;while (!exists) {for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i+3] == 0xFFFFFF8C) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "50Hz配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "元素不存在，继续执行某条语句..." << std::endl;// 可以在这里添加需要执行的语句}}//sensorThreadObj.join();return 0;
}

完整代码段：

#include <Windows.h>#include <iostream>
#include <iomanip>
#include <iostream>
#include <chrono>
#include <thread>
#include <iostream>
#include <iomanip> 
#include <iostream>
#include <sstream> 
#include <iomanip>HANDLE hSerial;
DCB dcbSerialParams = { 0 };
COMMTIMEOUTS timeouts = { 0 };
DWORD bytesRead, bytesRead1, bytesWritten, bytesWritten1, bytesWritten2, bytesWritten3, bytesWritten4, bytesWritten5, response_R1;char command_R[] = { 0x77, 0x04, 0x00, 0x04, 0x08 };//读X、Y轴角度 发送命令： 77 04 00 04 08
char response_R[34];
double Sensor_Angle_RX0;
double Sensor_Angle_RY0;char dataReceived[34];
const int interval = 100;void sensorThread()
{std::cout << " " << std::endl;std::cout << "开始采集 " << std::endl;int i = 0;while (1){auto startTime = std::chrono::high_resolution_clock::now();ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL);for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}bool flag1 = false;int flag;for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 1] == 0x10 && dataReceived[i + 2] == 0x00 && dataReceived[i + 3] == 0xFFFFFF84){flag1 = true;flag = i;break;}}std::cout << "" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(4000));if (flag1 == true){//x轴// Given hexadecimal valuesint hexValues[] = { dataReceived[flag + 5] & 0xFF, dataReceived[flag + 6] & 0xFF, dataReceived[flag + 7] & 0xFF };int hexValues1[] = { dataReceived[flag + 9] & 0xFF, dataReceived[flag + 10] & 0xFF, dataReceived[flag + 11] & 0xFF };int numValues = sizeof(hexValues) / sizeof(hexValues[0]);std::stringstream ss;ss << std::setfill('0') << std::setw(2) << std::hex << hexValues[0];for (int i = 1; i < numValues; i++) {ss << "." << std::setw(2) << std::hex << hexValues[i];}std::string resultString = ss.str();std::string inputString = resultString;std::string outputString;size_t firstDotIndex = inputString.find('.');size_t secondDotIndex = inputString.find('.', firstDotIndex + 1);if (firstDotIndex != std::string::npos && secondDotIndex != std::string::npos) {outputString = inputString.substr(0, secondDotIndex) + inputString.substr(secondDotIndex + 1);}else {outputString = inputString;}double resultDouble = std::stod(outputString);if (dataReceived[flag + 4] == 0x00){Sensor_Angle_RX0 = resultDouble;}else{Sensor_Angle_RX0 = -resultDouble;}std::cout << "x轴角度" << Sensor_Angle_RX0 << std::endl;//Y轴int numValues1 = sizeof(hexValues1) / sizeof(hexValues1[0]);std::stringstream ss1;ss1 << std::setfill('0') << std::setw(2) << std::hex << hexValues1[0];for (int i = 1; i < numValues1; i++) {ss1 << "." << std::setw(2) << std::hex << hexValues1[i];}std::string resultString1 = ss1.str();std::string inputString1 = resultString1;std::string outputString1;size_t firstDotIndex1 = inputString1.find('.');size_t secondDotIndex1 = inputString1.find('.', firstDotIndex1 + 1);if (firstDotIndex1 != std::string::npos && secondDotIndex1 != std::string::npos) {outputString1 = inputString1.substr(0, secondDotIndex1) + inputString1.substr(secondDotIndex1 + 1);}else {outputString1 = inputString1;}double resultDouble1 = std::stod(outputString1);if (dataReceived[flag + 8] == 0x00){Sensor_Angle_RY0 = resultDouble1;}else{Sensor_Angle_RY0 = -resultDouble1;}std::cout << "y轴: " << Sensor_Angle_RY0 << std::endl;// 计算执行代码所花费的时间auto endTime = std::chrono::high_resolution_clock::now();auto duration = std::chrono::duration_cast<std::chrono::milliseconds>(endTime - startTime);// 计算需要延迟的时间int delay = interval - duration.count();//std::cout << delay << std::endl;if (delay == interval){std::cout << "频率正确" << std::endl;}else if (delay > 0) {// 延迟执行std::this_thread::sleep_for(std::chrono::milliseconds(delay));std::cout << "频率正确" << std::endl;}else if (delay < 0){std::cout << "时间不够：（ms）***************************************：" << delay << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(200000000));}}}//std::this_thread::sleep_for(std::chrono::milliseconds(2000));}int main()
{// 创建传感器数据读取线程std::thread sensorThreadObj(sensorThread);//CString str123 = strValue1;//CString strA("COM10");//CString strB("\\\\.\\");//strB += strA;//const char* portName = strB.GetString();//strB.ReleaseBuffer();//strA.ReleaseBuffer();wchar_t portName[] = L"\\\\.\\COM10"; // Note the 'L' before the stringhSerial = CreateFile("\\\\.\\COM10", GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL);if (hSerial == INVALID_HANDLE_VALUE) {if (GetLastError() == ERROR_FILE_NOT_FOUND) {std::cout << "Serial port not available." << std::endl;}return 1;}dcbSerialParams.DCBlength = sizeof(dcbSerialParams);if (!GetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error getting serial port state." << std::endl;CloseHandle(hSerial);return 1;}dcbSerialParams.BaudRate = CBR_9600;dcbSerialParams.ByteSize = 8;dcbSerialParams.StopBits = ONESTOPBIT;dcbSerialParams.Parity = NOPARITY;if (!SetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial);return 1;}timeouts.ReadIntervalTimeout = 500;timeouts.ReadTotalTimeoutConstant = 500;timeouts.ReadTotalTimeoutMultiplier = 100;timeouts.WriteTotalTimeoutConstant = 500;timeouts.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial, &timeouts)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial);return 1;}//默认为9600的时候，进行对话模式char command_R4[] = { 0x77, 0x05, 0x00, 0x0C, 0x00, 0x11 };if (!WriteFile(hSerial, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "第一次9600的对话模式配置失败" << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "第一次9600的对话模式数据读取失败." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "第一次初始波特率:" << dcbSerialParams.BaudRate << std::endl;for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}bool exists = false; // 标志位，记录元素是否存在int falsecount = 0;// 循环遍历数组while (!exists) {for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 3] == 0xFFFFFF8C) {exists = true; // 元素存在，设置标志位为truestd::cout << falsecount << std::endl;std::cout << "应答模式配置成功！" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(400000));break; // 跳出for循环}}if (exists){break;}if (!exists) {falsecount++;if (falsecount >= 2)//说明原有配置是115200波特率{dcbSerialParams.BaudRate = CBR_115200;dcbSerialParams.ByteSize = 8;dcbSerialParams.StopBits = ONESTOPBIT;dcbSerialParams.Parity = NOPARITY;if (!SetCommState(hSerial, &dcbSerialParams)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial);return 1;}timeouts.ReadIntervalTimeout = 500;timeouts.ReadTotalTimeoutConstant = 500;timeouts.ReadTotalTimeoutMultiplier = 100;timeouts.WriteTotalTimeoutConstant = 500;timeouts.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial, &timeouts)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial);return 1;}}if (!WriteFile(hSerial, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "115200的对话模式配置失败." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "115200的对话模式回复失败." << std::endl;CloseHandle(hSerial);return 1;}}}//设置频率为115200char command_R1[] = { 0x77, 0x05, 0x00, 0x0B, 0x04, 0x14 };//115200 if (!WriteFile(hSerial, command_R1, sizeof(command_R1), &bytesWritten1, NULL)){std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)){std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}exists = false;while (!exists){for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i + 3] == 0xFFFFFF8B) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "115200波特率配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial, command_R1, sizeof(command_R1), &bytesWritten1, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "重复配置115200波特率" << std::endl;// 可以在这里添加需要执行的语句std::this_thread::sleep_for(std::chrono::milliseconds(4000));}}//00-11:应答模式 05-50Hz 04-25Hz//06-100     05-50     04-25    char command_R3[] = { 0x77, 0x05, 0x00, 0x0C, 0x03, 0x14 };//50Hzif (!WriteFile(hSerial, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}exists = false;while (!exists) {for (int i = 0; i < sizeof(dataReceived); i++) {printf("%02X ", dataReceived[i]);}for (int i = 0; i < sizeof(dataReceived); i++) {if (dataReceived[i] == 0x77 && dataReceived[i+3] == 0xFFFFFF8C) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "50Hz配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial);return 1;}if (!ReadFile(hSerial, dataReceived, sizeof(dataReceived), &bytesRead, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial);return 1;}std::cout << "元素不存在，继续执行某条语句..." << std::endl;// 可以在这里添加需要执行的语句}}//sensorThreadObj.join();return 0;
}

我不知道为啥，程序可以正常运行，但是时间过长的情况下，偶尔会出现下面的这个问题（如果哪个大佬要是知道可以告诉我一下，学习学习）：

问题二：界面化设计（简化版）

前面已经完成了对于倾角传感器初步的设定与时间延缓问题的补偿，下一步需要对于倾角传感器的界面进行设计了。不写那么复杂，直接就是连接之后实时显示。

其中，Combo Box的ID我设置为IDC_COMBO1。x轴、y轴控件之间添加变量为m_x11、x_x22。可以见到在.h文件之中生成绑定变量。

在.h之中添加自己想要的变量。

HANDLE hSerial_L;DCB dcbSerialParams_L = { 0 };COMMTIMEOUTS timeouts_L = { 0 };DWORD bytesRead_L, bytesRead_L1, bytesWritten, bytesWritten1, bytesWritten2, bytesWritten3, bytesWritten4, bytesWritten5, response_R1;char dataReceived[34];const int interval = 100;char dataReceived_L[23];

在.cpp的初始化函数OnInit之中添加线程监控与按钮初始化

AfxBeginThread(ReadCom1Thread, this);CComboBox* pCombo_S_L = (CComboBox*)GetDlgItem(IDC_COMBO1);pCombo_S_L->AddString(_T("断开连接"));pCombo_S_L->AddString(_T("COM1"));pCombo_S_L->AddString(_T("COM2"));pCombo_S_L->AddString(_T("COM3"));pCombo_S_L->AddString(_T("COM4"));pCombo_S_L->AddString(_T("COM5"));pCombo_S_L->AddString(_T("COM6"));pCombo_S_L->AddString(_T("COM7"));pCombo_S_L->AddString(_T("COM8"));pCombo_S_L->AddString(_T("COM9"));pCombo_S_L->AddString(_T("COM10"));pCombo_S_L->AddString(_T("COM11"));pCombo_S_L->AddString(_T("COM12"));pCombo_S_L->AddString(_T("COM13"));pCombo_S_L->AddString(_T("COM14"));pCombo_S_L->AddString(_T("COM15"));pCombo_S_L->AddString(_T("COM16"));pCombo_S_L->AddString(_T("COM17"));pCombo_S_L->AddString(_T("COM18"));pCombo_S_L->AddString(_T("COM19"));pCombo_S_L->AddString(_T("COM20"));pCombo_S_L->SetCurSel(0);

线程函数如下所示：


volatile bool bThreadRunning1 = false; // 线程1运行标志
//UINT CMFCApplication1Dlg::ReadCom1Thread(LPVOID pParam)
UINT ReadCom1Thread(LPVOID pParam)
{CMFCApplication1Dlg* pDlg = (CMFCApplication1Dlg*)pParam;CString strText;bThreadRunning1 = true;double LX, LY;std::cout << " " << std::endl;std::cout << "开始采集 " << std::endl;int i = 0;while (1){auto startTime = std::chrono::high_resolution_clock::now();ReadFile(pDlg->hSerial_L, pDlg->dataReceived, sizeof(pDlg->dataReceived), &(pDlg->bytesRead_L), NULL);for (int i = 0; i < sizeof(pDlg->dataReceived); i++) {printf("%02X ", pDlg->dataReceived[i]);}bool flag1 = false;int flag;for (int i = 0; i < sizeof(pDlg->dataReceived); i++) {if (pDlg->dataReceived[i] == 0x77 && pDlg->dataReceived[i + 1] == 0x10 && pDlg->dataReceived[i + 2] == 0x00 && pDlg->dataReceived[i + 3] == 0xFFFFFF84){flag1 = true;flag = i;break;}}std::cout << "" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(4000));if (flag1 == true){//x轴// Given hexadecimal valuesint hexValues[] = { pDlg->dataReceived[flag + 5] & 0xFF, pDlg->dataReceived[flag + 6] & 0xFF, pDlg->dataReceived[flag + 7] & 0xFF };int hexValues1[] = { pDlg->dataReceived[flag + 9] & 0xFF, pDlg->dataReceived[flag + 10] & 0xFF, pDlg->dataReceived[flag + 11] & 0xFF };int numValues = sizeof(hexValues) / sizeof(hexValues[0]);std::stringstream ss;ss << std::setfill('0') << std::setw(2) << std::hex << hexValues[0];for (int i = 1; i < numValues; i++) {ss << "." << std::setw(2) << std::hex << hexValues[i];}std::string resultString = ss.str();std::string inputString = resultString;std::string outputString;size_t firstDotIndex = inputString.find('.');size_t secondDotIndex = inputString.find('.', firstDotIndex + 1);if (firstDotIndex != std::string::npos && secondDotIndex != std::string::npos) {outputString = inputString.substr(0, secondDotIndex) + inputString.substr(secondDotIndex + 1);}else {outputString = inputString;}double resultDouble = std::stod(outputString);if (pDlg->dataReceived[flag + 4] == 0x00){LX = resultDouble;}else{LX = -resultDouble;}//Y轴int numValues1 = sizeof(hexValues1) / sizeof(hexValues1[0]);std::stringstream ss1;ss1 << std::setfill('0') << std::setw(2) << std::hex << hexValues1[0];for (int i = 1; i < numValues1; i++) {ss1 << "." << std::setw(2) << std::hex << hexValues1[i];}std::string resultString1 = ss1.str();std::string inputString1 = resultString1;std::string outputString1;size_t firstDotIndex1 = inputString1.find('.');size_t secondDotIndex1 = inputString1.find('.', firstDotIndex1 + 1);if (firstDotIndex1 != std::string::npos && secondDotIndex1 != std::string::npos) {outputString1 = inputString1.substr(0, secondDotIndex1) + inputString1.substr(secondDotIndex1 + 1);}else {outputString1 = inputString1;}double resultDouble1 = std::stod(outputString1);if (pDlg->dataReceived[flag + 8] == 0x00){LY = resultDouble1;}else{LY = -resultDouble1;}CString strValue;strValue.Format(_T("%.4f°"), LX); // 将 double 值转换成字符串，保留四位小数pDlg->m_x11.ResetContent();pDlg->m_x11.AddString(strValue); // 将字符串添加到 ListBox 中CString strValue1;strValue1.Format(_T("%.4f°"), LY); // 将 double 值转换成字符串，保留四位小数pDlg->m_x22.ResetContent();pDlg->m_x22.AddString(strValue1); // 将字符串添加到 ListBox 中// 计算执行代码所花费的时间auto endTime = std::chrono::high_resolution_clock::now();auto duration = std::chrono::duration_cast<std::chrono::milliseconds>(endTime - startTime);// 计算需要延迟的时间int delay = pDlg->interval - duration.count();//std::cout << delay << std::endl;if (delay == pDlg->interval){std::cout << "频率正确" << std::endl;}else if (delay > 0) {// 延迟执行std::this_thread::sleep_for(std::chrono::milliseconds(delay));std::cout << "频率正确" << std::endl;}else if (delay < 0){std::cout << "时间不够：（ms）***************************************：" << delay << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(200000000));}}}//// 关闭串口1CloseHandle(pDlg->hSerial_L);return 0;
}

双击COM口选择控件，添加如下函数


void CMFCApplication1Dlg::OnCbnSelchangeCombo1()
{// TODO: 在此添加控件通知处理程序代码// TODO: 在此添加控件通知处理程序代码CComboBox* pCombo12 = (CComboBox*)GetDlgItem(IDC_COMBO1);CString strValue1;pCombo12->GetLBText(pCombo12->GetCurSel(), strValue1);CString vl11 = strValue1;CStringA strA(strValue1);CStringA strB("\\\\.\\");strB += strA;const char* portName = strB.GetString();// 释放 portName 的资源strB.ReleaseBuffer();strA.ReleaseBuffer();CString duankai("断开连接");if (vl11 == duankai){MessageBox(L"断开与倾角传感器的连接");}else{CStringW widePortName(portName);hSerial_L = CreateFile(widePortName, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL);//hSerial = CreateFile(portName, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL);if (hSerial_L == INVALID_HANDLE_VALUE) {if (GetLastError() == ERROR_FILE_NOT_FOUND) {std::cout << "Serial port not available." << std::endl;}}dcbSerialParams_L.DCBlength = sizeof(dcbSerialParams_L);if (!GetCommState(hSerial_L, &dcbSerialParams_L)) {std::cout << "Error getting serial port state." << std::endl;CloseHandle(hSerial_L);}dcbSerialParams_L.BaudRate = CBR_9600;dcbSerialParams_L.ByteSize = 8;dcbSerialParams_L.StopBits = ONESTOPBIT;dcbSerialParams_L.Parity = NOPARITY;if (!SetCommState(hSerial_L, &dcbSerialParams_L)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial_L);}timeouts_L.ReadIntervalTimeout = 500;timeouts_L.ReadTotalTimeoutConstant = 500;timeouts_L.ReadTotalTimeoutMultiplier = 100;timeouts_L.WriteTotalTimeoutConstant = 500;timeouts_L.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial_L, &timeouts_L)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial_L);}//默认为9600的时候，进行对话模式char command_R4[] = { 0x77, 0x05, 0x00, 0x0C, 0x00, 0x11 };if (!WriteFile(hSerial_L, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "第一次9600的对话模式配置失败" << std::endl;CloseHandle(hSerial_L);}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)) {std::cout << "第一次9600的对话模式数据读取失败." << std::endl;CloseHandle(hSerial_L);}std::cout << "第一次初始波特率:" << dcbSerialParams_L.BaudRate << std::endl;for (int i = 0; i < sizeof(dataReceived_L); i++) {printf("%02X ", dataReceived_L[i]);}bool exists = false; // 标志位，记录元素是否存在int falsecount = 0;// 循环遍历数组while (!exists) {for (int i = 0; i < sizeof(dataReceived_L); i++) {printf("%02X ", dataReceived_L[i]);}for (int i = 0; i < sizeof(dataReceived_L); i++) {if (dataReceived_L[i] == 0x77 && dataReceived_L[i + 3] == 0xFFFFFF8C) {exists = true; // 元素存在，设置标志位为truestd::cout << falsecount << std::endl;std::cout << "应答模式配置成功！" << std::endl;//std::this_thread::sleep_for(std::chrono::milliseconds(400000));break; // 跳出for循环}}if (exists){break;}if (!exists) {falsecount++;if (falsecount >= 2)//说明原有配置是115200波特率{dcbSerialParams_L.BaudRate = CBR_115200;dcbSerialParams_L.ByteSize = 8;dcbSerialParams_L.StopBits = ONESTOPBIT;dcbSerialParams_L.Parity = NOPARITY;if (!SetCommState(hSerial_L, &dcbSerialParams_L)) {std::cout << "Error setting serial port state." << std::endl;CloseHandle(hSerial_L);}timeouts_L.ReadIntervalTimeout = 500;timeouts_L.ReadTotalTimeoutConstant = 500;timeouts_L.ReadTotalTimeoutMultiplier = 100;timeouts_L.WriteTotalTimeoutConstant = 500;timeouts_L.WriteTotalTimeoutMultiplier = 100;if (!SetCommTimeouts(hSerial_L, &timeouts_L)){std::cout << "Error setting timeouts." << std::endl;CloseHandle(hSerial_L);}}if (!WriteFile(hSerial_L, command_R4, sizeof(command_R4), &bytesWritten4, NULL)) {std::cout << "115200的对话模式配置失败." << std::endl;CloseHandle(hSerial_L);}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)) {std::cout << "115200的对话模式回复失败." << std::endl;CloseHandle(hSerial_L);}}}//设置频率为115200char command_R1[] = { 0x77, 0x05, 0x00, 0x0B, 0x04, 0x14 };//115200 if (!WriteFile(hSerial_L, command_R1, sizeof(command_R1), &bytesWritten1, NULL)){std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial_L);}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)){std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial_L);}exists = false;while (!exists){for (int i = 0; i < sizeof(dataReceived_L); i++) {printf("%02X ", dataReceived_L[i]);}for (int i = 0; i < sizeof(dataReceived_L); i++) {if (dataReceived_L[i] == 0x77 && dataReceived_L[i + 3] == 0xFFFFFF8B) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "115200波特率配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial_L, command_R1, sizeof(command_R1), &bytesWritten1, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial_L);}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial_L);}std::cout << "重复配置115200波特率" << std::endl;// 可以在这里添加需要执行的语句}}//00-11:应答模式 05-50Hz 04-25Hz//06-100     05-50     04-25    char command_R3[] = { 0x77, 0x05, 0x00, 0x0C, 0x03, 0x14 };//50Hzif (!WriteFile(hSerial_L, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial_L);}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial_L);}for (int i = 0; i < sizeof(dataReceived_L); i++) {printf("%02X ", dataReceived_L[i]);}exists = false;while (!exists) {for (int i = 0; i < sizeof(dataReceived_L); i++) {printf("%02X ", dataReceived_L[i]);}for (int i = 0; i < sizeof(dataReceived_L); i++) {if (dataReceived_L[i] == 0x77 && dataReceived_L[i + 3] == 0xFFFFFF8C) {//设置成功exists = true; // 元素存在，设置标志位为truestd::cout << "50Hz配置成功！" << std::endl;break; // 跳出for循环}}if (exists){break;}if (!exists) {if (!WriteFile(hSerial_L, command_R3, sizeof(command_R3), &bytesWritten3, NULL)) {std::cout << "Error writing to serial port." << std::endl;CloseHandle(hSerial_L);;}if (!ReadFile(hSerial_L, dataReceived_L, sizeof(dataReceived_L), &bytesRead_L, NULL)) {std::cout << "Error reading from serial port." << std::endl;CloseHandle(hSerial_L);}std::cout << "元素不存在，继续执行某条语句..." << std::endl;// 可以在这里添加需要执行的语句}}}}

实时读取界面完成。

问题三：时间同步问题

因为在实际的使用过程之中，需要用到的数据不可能只是一个倾角传感器的数据，如何进行多传感器的时间的同步是一个比较重要的问题。

针对于这个时间帧对齐方式，当存在多个传感器的时候，多个传感器的输出频率是不一致的情况下，最佳的方式是将其频率调节到整数倍的情况下。然后使用插值的方式使得其帧率变为一致的情况。

以相机而言，如下所示，可以调用相机的SDK进行人为设置相机的帧率。

可以见到相应的相机的帧率是稳定不变的，以将相机与倾角传感器时间帧进行对齐为例。首先，选定一个参考物也就是所谓的时间的参考物，我是以相机为参考时间的，将倾角传感器的频率设置为100Hz，由于此处我是将receive的长度设置为34，也就是采集长度的二倍，因此实际输出的频率为原来的1/2，也就是50Hz。（这样做的目的是方式出现丢帧的问题）

我的想法是使用时间戳的方式进行对齐，首先将相机的帧率设置为10FPS，需要进行注意的是相机设置为10FPS的过程，相机是逐渐成为10FPS的，有一个时间延迟，延迟一段时间并且记录下此时的时间戳t1。同理，倾角传感器在进行采集的过程之中也是存在相应的时间延迟，延迟之后记录下此时的时间戳t2。

其含义为相机在t1时刻以后以10Hz的频率进行采集，倾角传感器在t2时刻以后以50Hz的频率进行采集。其中10Hz对应100ms/次，50Hz对应20ms/次。其中如何对齐，后面再想。

这篇关于BWS2000倾角传感器c++测试代码_时间延迟与时间同步问题【3】的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/525054。

相关文章

线上Java OOM问题定位与解决方案超详细解析

线上Java OOM问题定位与解决方案超详细解析

《线上JavaOOM问题定位与解决方案超详细解析》OOM是JVM抛出的错误,表示内存分配失败,：本文主要介绍线上JavaOOM问题定位与解决方案的相关资料,文中通过代码介绍的非常详细,需要的朋... 目录一、OOM问题核心认知1.1 OOM定义与技术定位1.2 OOM常见类型及技术特征二、OOM问题定位工具
阅读更多...
Python的Darts库实现时间序列预测

Python的Darts库实现时间序列预测

《Python的Darts库实现时间序列预测》Darts一个集统计、机器学习与深度学习模型于一体的Python时间序列预测库,本文主要介绍了Python的Darts库实现时间序列预测,感兴趣的可以了解... 目录目录一、什么是 Darts？二、安装与基本配置安装 Darts导入基础模块三、时间序列数据结构与
阅读更多...
C++右移运算符的一个小坑及解决

C++右移运算符的一个小坑及解决

《C++右移运算符的一个小坑及解决》文章指出右移运算符处理负数时左侧补1导致死循环,与除法行为不同,强调需注意补码机制以正确统计二进制1的个数... 目录我遇到了这么一个www.chinasem.cn函数由此可以看到也很好理解总结我遇到了这么一个函数template<typename T>unsigned
阅读更多...
MyBatis Plus实现时间字段自动填充的完整方案

MyBatis Plus实现时间字段自动填充的完整方案

《MyBatisPlus实现时间字段自动填充的完整方案》在日常开发中,我们经常需要记录数据的创建时间和更新时间,传统的做法是在每次插入或更新操作时手动设置这些时间字段,这种方式不仅繁琐,还容易遗漏,... 目录前言解决目标技术栈实现步骤1. 实体类注解配置2. 创建元数据处理器3. 服务层代码优化填充机制详
阅读更多...
C++统计函数执行时间的最佳实践

C++统计函数执行时间的最佳实践

《C++统计函数执行时间的最佳实践》在软件开发过程中,性能分析是优化程序的重要环节,了解函数的执行时间分布对于识别性能瓶颈至关重要,本文将分享一个C++函数执行时间统计工具,希望对大家有所帮助... 目录前言工具特性核心设计1. 数据结构设计2. 单例模式管理器3. RAII自动计时使用方法基本用法高级用法
阅读更多...
Vue3绑定props默认值问题

Vue3绑定props默认值问题

《Vue3绑定props默认值问题》使用Vue3的defineProps配合TypeScript的interface定义props类型,并通过withDefaults设置默认值,使组件能安全访问传入的... 目录前言步骤步骤1：使用 defineProps 定义 Props步骤2：设置默认值总结前言使用T
阅读更多...
Python与MySQL实现数据库实时同步的详细步骤

Python与MySQL实现数据库实时同步的详细步骤

《Python与MySQL实现数据库实时同步的详细步骤》在日常开发中,数据同步是一项常见的需求,本篇文章将使用Python和MySQL来实现数据库实时同步,我们将围绕数据变更捕获、数据处理和数据写入这... 目录前言摘要概述：数据同步方案1. 基本思路2. mysql Binlog 简介实现步骤与代码示例1
阅读更多...
Web服务器-Nginx-高并发问题

Web服务器-Nginx-高并发问题

《Web服务器-Nginx-高并发问题》Nginx通过事件驱动、I/O多路复用和异步非阻塞技术高效处理高并发,结合动静分离和限流策略,提升性能与稳定性... 目录前言一、架构1. 原生多进程架构2. 事件驱动模型3. IO多路复用4. 异步非阻塞 I/O5. Nginx高并发配置实战二、动静分离1. 职责2
阅读更多...
解决升级JDK报错:module java.base does not“opens java.lang.reflect“to unnamed module问题

解决升级JDK报错:module java.base does not“opens java.lang.reflect“to unnamed module问题

《解决升级JDK报错:modulejava.basedoesnot“opensjava.lang.reflect“tounnamedmodule问题》SpringBoot启动错误源于Jav... 目录问题描述原因分析解决方案总结问题描述启动sprintboot时报以下错误原因分析编程异js常是由Ja
阅读更多...
C# LiteDB处理时间序列数据的高性能解决方案

C# LiteDB处理时间序列数据的高性能解决方案

《C#LiteDB处理时间序列数据的高性能解决方案》LiteDB作为.NET生态下的轻量级嵌入式NoSQL数据库,一直是时间序列处理的优选方案,本文将为大家大家简单介绍一下LiteDB处理时间序列数... 目录为什么选择LiteDB处理时间序列数据第一章：LiteDB时间序列数据模型设计1.1 核心设计原则
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2