debug-12
This commit is contained in:
parent
684c1dac84
commit
608f794be7
@ -27,7 +27,7 @@ def generate_launch_description():
|
||||
#串口设备串 defaule: /dev/ttyUSB0
|
||||
{"UART_Port": "/dev/ttyTHS1"},
|
||||
#串口波特率 default: 115200
|
||||
{"UART_Baudrate": 460800},
|
||||
{"UART_Baudrate": 115200},
|
||||
#latency_timer :1 ~ 16, default:16
|
||||
{"USB_LatencyTime": 16},
|
||||
|
||||
|
||||
@ -142,26 +142,9 @@ void AGPbox::readSerialPort()
|
||||
{
|
||||
if (imu_ser.isOpen())
|
||||
{
|
||||
size_t available = imu_ser.available();
|
||||
if(available > 0)
|
||||
if(imu_ser.available())
|
||||
{
|
||||
TinyLog::info("Serial available: %zu bytes", available);
|
||||
m_read = imu_ser.read(available);
|
||||
TinyLog::info("Serial read: %zu bytes", m_read.size());
|
||||
|
||||
// 打印前16字节用于调试
|
||||
if(m_read.size() > 0)
|
||||
{
|
||||
std::string hex_str = "";
|
||||
for(size_t i = 0; i < std::min(m_read.size(), (size_t)16); i++)
|
||||
{
|
||||
char buf[4];
|
||||
sprintf(buf, "%02X ", (uint8_t)m_read[i]);
|
||||
hex_str += buf;
|
||||
}
|
||||
TinyLog::info("First 16 bytes: %s", hex_str.c_str());
|
||||
}
|
||||
|
||||
m_read = imu_ser.read(imu_ser.available());
|
||||
m_input += m_read;
|
||||
connect_manager.addData(m_input);
|
||||
m_input.erase(0, m_input.size());
|
||||
|
||||
Loading…
Reference in New Issue
Block a user