pixhawk 自定义uart的应用
pixhawk + uart串口新建一个uart.msg文件新建一个文件读取串口的数据使其在程序中传递串口数据，并进行运算
<hr>
读取串口数据（坐标信息）
准备工作准备一个uart设备，能够发送数据。这里我使用32开发板作为载体，向px4发送坐标信息，发送的数据格式为 ‘s:1234,1234,1234\r’单位为毫米。开发px4代码定义消息首先在msg的文件夹下创建uart_pos.msg文件，然后在里面自定义数据类型，
uint32 id # ID of the estimator, commonly the component ID of the incoming message
int32 int_x # Z postiton in meters in the NED earth-fixed frame
int32 int_y # Z postiton in meters in the NED earth-fixed frame
int32 int_z # Z postiton in meters in the NED earth-fixed frame
CMakeLists.txt中注册 在./msg/CMakeLists.txt中注册
set(msg_files...wind_estimate.msguart_pos.msg)12345读取uart数据在./src/modules中新建文件夹read_uart 在文件夹中添加read_uart.c与CMakelists.txtread_uart.c内容主要如下：初始化 px4使用nuttx操作系统，所以我们不能直接像使用32库的方式来配置uart，nuttx 提供了uart的驱动，我们 只需要取调用就可以了:
/*初始化串口*/int uart_read = uart_init(uart_name);if(false == uart_read)return -1;/*设置波特率*/if(false == set_uart_baudrate(uart_read,115200)){ printf("set_uart_baudrate is failed\n"); return -1;}printf("uart init is successful\n");12345678910uart_init(uart_name) 返回一个句柄，uart_name 可以在rcS脚本中找到，其中写着uart的具体名称:
/* * TELEM1 : /dev/ttyS1 * TELEM2 : /dev/ttyS2 * GPS : /dev/ttyS3 * NSH : /dev/ttyS5 * SERIAL4: /dev/ttyS6 * N/A : /dev/ttyS4 * IO DEBUG (RX only):/dev/ttyS0 */123456789读取数据
while(!thread_should_exit){ read(uart_read,&data,1); read_uart(data); }12345数据保存到data数据处理与数据发送
int read_uart(char data){ static int i=0; static char rx_buff; static char state=0; static int times = 0; times ++; // int x,y,z; if(state ==0 || data == 's')//数据起始位 { i=0; memset(rx_buff,0,sizeof(rx_buff)); state = 1; }else if(state == 1&&data ==':'){ state = 2; }else if(state ==2 ){ if(data == '\r')//数据结束位 { sscanf(rx_buff,"%d,%d,%d",&uart_data.int_x,&uart_data.int_y,&uart_data.int_z); if(times %500 == 0)//发送到控制台 mavlink_and_console_log_info(&mavlink_uart_pub, "ok %d %d %d",uart_data.int_x,uart_data.int_y,uart_data.int_z); state = 0; return 0; } rx_buff = data; i++; } else state = 0; return 0;}1234567891011121314151617181920212223242526272829303132注册到飞控中./src/modules/read_uart/CMakelists.txt中： 添加
px4_add_module( MODULE modules__read_uart MAIN read_uart_sensor COMPILE_FLAGS -Os SRCS read_uart.c DEPENDS platforms__common )12345678910./cmake/config/nuttx_px4fmu-v2_default.cmake添加
modules/sensors1在控制台输入
make px4fmu-v2_default upload
将生成的固件下载到pix中，然后在qgc的控制台上输入？应该能看到
这时接着输入read_uart_sensor start /dev/ttyS4（ttyS4是根据你连接的串口，
* TELEM1 : /dev/ttyS1
* TELEM2 : /dev/ttyS2
* GPS : /dev/ttyS3
* NSH : /dev/ttyS5
* SERIAL4: /dev/ttyS6
* N/A : /dev/ttyS4
* IO DEBUG (RX only):/dev/ttyS0）
这时你应该可以看到数据在通知栏和控制台上
页:
[1]