From: penglei <1624952103@qq.com> Date: Wed, 19 Nov 2025 02:43:38 +0000 (+0800) Subject: gps蓝牙产测增加经纬度坐标信息 X-Git-Tag: V1.0.9_20251128_194606_LN~49^2~2 X-Git-Url: http://git.snicker.com.cn/css/static/script.js?a=commitdiff_plain;h=89d7d79c8c63e7e7fc16c0a7582fdab734d7f1d9;p=mirrors%2FFD230.git gps蓝牙产测增加经纬度坐标信息 --- diff --git a/code/sdk/zhihui/services/factorytest_service/factorytest_protocol.c b/code/sdk/zhihui/services/factorytest_service/factorytest_protocol.c index a39f9eb40..a3471b0bf 100644 --- a/code/sdk/zhihui/services/factorytest_service/factorytest_protocol.c +++ b/code/sdk/zhihui/services/factorytest_service/factorytest_protocol.c @@ -2,7 +2,7 @@ * @Author: penglei 1624952103@qq.com * @Date: 2024-06-17 14:31:08 * @LastEditors: penglei 1624952103@qq.com - * @LastEditTime: 2025-11-17 10:55:49 + * @LastEditTime: 2025-11-19 10:43:10 * @FilePath: /FD230/code/sdk/application/wearable/service/factorytest_service/factorytest_protocol.c * @Description: * @@ -2408,24 +2408,44 @@ void factorytest_protocol_soft_test_decode(uint8_t submode,uint8_t testitem,uint } else if(testitem == 0x02) { //获取可见星 有效星 信号增益 定位精度 - uint8_t send_data[7] = {0}; + uint8_t send_data[15] = {0}; #ifdef SUPPORT_GNSS // if(send_gps_data) { + uint32_t lat = (uint32_t)(send_gps_data.location.lat * 1000000.0f); + uint32_t lng = (uint32_t)(send_gps_data.location.lng * 1000000.0f); + + // uint32_t lat = (uint32_t)(22.575890 * 1000000.0f); + // uint32_t lng = (uint32_t)(114.055733 * 1000000.0f); + send_data[0] = send_gps_data.num_sats; send_data[1] = send_gps_data.th001_valid_star_count; send_data[2] = send_gps_data.th000_signal_vga; + send_data[3] = (uint8_t)(((uint32_t)send_gps_data.th001_quality & 0xFF000000) >> 24); send_data[4] = (uint8_t)(((uint32_t)send_gps_data.th001_quality & 0x00FF0000) >> 16); send_data[5] = (uint8_t)(((uint32_t)send_gps_data.th001_quality & 0x0000FF00) >> 8); send_data[6] = (uint8_t)(((uint32_t)send_gps_data.th001_quality & 0x000000FF) >> 0); - PRINT("gps_data->num_sats : %d,gps_data->th001_valid_star_count : %d,gps_data->th000_signal_vga : %d,gps_data->th001_quality : %f\n", + send_data[7] = (uint8_t)((lat & 0xFF000000) >> 24); + send_data[8] = (uint8_t)((lat & 0x00FF0000) >> 16); + send_data[9] = (uint8_t)((lat & 0x0000FF00) >> 8); + send_data[10] = (uint8_t)((lat & 0x000000FF) >> 0); + + send_data[11] = (uint8_t)((lng & 0xFF000000) >> 24); + send_data[12] = (uint8_t)((lng & 0x00FF0000) >> 16); + send_data[13] = (uint8_t)((lng & 0x0000FF00) >> 8); + send_data[14] = (uint8_t)((lng & 0x000000FF) >> 0); + + + PRINT("gps_data->num_sats : %d,gps_data->th001_valid_star_count : %d,gps_data->th000_signal_vga : %d,gps_data->th001_quality : %f,lat:%lu, lng:%lu \n", send_gps_data.num_sats,send_gps_data.th001_valid_star_count, - send_gps_data.th000_signal_vga,send_gps_data.th001_quality - ); + send_gps_data.th000_signal_vga,send_gps_data.th001_quality,lat,lng); + PRINT("%2X %2X %2X\r\n",send_data[0],send_data[1],send_data[2]); PRINT("%2X %2X %2X %2X \r\n",send_data[3],send_data[4],send_data[5],send_data[6]); + PRINT("%2X %2X %2X %2X \r\n",send_data[7],send_data[8],send_data[9],send_data[10]); + PRINT("%2X %2X %2X %2X \r\n",send_data[11],send_data[12],send_data[13],send_data[14]); } #endif factorytest_protocol_replymsg(BLE_TEST_CMD_MODE_SOFT_TEST,