組合慣導串口數據解析

首先是給串口usb以權限:

sudo chmod 666 /dev/ttyUSB0

但是不能每次啟動都執行一次,所以需要給一個永久的權限指令:

sudo gedit /etc/udev/rules.d/70-ttyusb.rules
KERNEL==“ttyUSB[0-9]*, MODE=0666

然后就能讓ttyUSB0-ttyUSB9默認的權限都變成了666,普通用戶也可以讀寫串口了。

或者將其添加到一個組:

ls -l /dev/ttyUSB0
whoami

當前用戶加入到dialout用戶組

sudo usermod -aG dialout username

然后重啟即可。
然后是用python解析串口的數據:

#!/usr/bin/env python3
# -*- coding: utf-8 -*-import json
import serial
import rospy
import std_msgs.msg
from car_interfaces.msg import GpsImuInterface, GpsImuAddInterface
import math
from datetime import datetime, timedelta
import time
import pyproj
import signal
import os
import sys# 獲取當前腳本文件的所在目錄
script_directory = os.path.dirname(os.path.abspath(__file__))
# 圖片文件相對于腳本文件的路徑
image_relative_path = 'lib'
# 構建圖片文件的完整路徑
icon_path = os.path.join(script_directory, image_relative_path)
# absolute_path = os.path.abspath(icon_path)# print(absolute_path)
sys.path.append(icon_path)
from base_function import *buf_pos_lat = 0
buf_pos_lon = 0
buf_vel = 0
buf_angle_heading = 0def connect_to_serial(port_name, baud_rate):try:return serial.Serial(port_name, baudrate=baud_rate, timeout=1)except serial.SerialException as e:rospy.logerr(f"Unable to connect to {port_name} with baud rate {baud_rate}: {e}")return Nonedef read_from_port(serial_port):global buf_pos_latglobal buf_pos_longlobal buf_velglobal buf_angle_headingcontent = {}# 此處放置讀取串口的邏輯 ...# start = time.time()buf_new = serial_port.readline()# print("buf new",buf_new,"serial_port",serial_port)# print(buff)# print()if ("INSPVAXA" in buf_new.decode() and "FINESTEERING" in buf_new.decode()):buf_whole_array = buf_new.decode().split(";")buf_front_arary = buf_whole_array[0].split(",")# print(buf_whole_array)buf_back_array = buf_whole_array[1].split(",")buf_pos_lon = float(buf_back_array[3])buf_pos_lat = float(buf_back_array[2])# buf_pos_alt = float(buf_back_array[4])buf_vel_east= float(buf_back_array[7])buf_vel_north= float(buf_back_array[6])buf_vel_u= float(buf_back_array[8])# 車速通過串口拿不到數據buf_vel= math.sqrt(buf_vel_east**2+buf_vel_north**2+buf_vel_u**2)buf_angle_heading = angle_2_angle(float(buf_back_array[11]))if(buf_back_array[0] == "INS_SOLUTION_GOOD"):buf_system_state = 3else:buf_system_state = 0# 搜星數量buf_gps_num_sats_used = 0buf_gps_num_sats_1 = 0buf_gps_num_sats_2 = 0if buf_front_arary[4] == "FINEBACKUPSTEERING":buf_satellite_status = 1else:buf_satellite_status = 0# 差分延時buf_gps_age = 0buf_pos_x = 0buf_pos_y = 0# 進程處理時間buf_process_time=0# 慣導通信故障buf_gps_cfault = Falsecontent["time_stamp"] = time.time()content["Lat"] = buf_pos_lat # GPS_MSG.PosLatcontent["Lon"] = buf_pos_lon # GPS_MSG.PosLoncontent["Head"] = buf_angle_heading # GPS_MSG.AngleHeadingcontent["Speed"] = buf_vel # GPS_MSG.Velcontent["UTM_x"] = from_latlon(buf_pos_lat, buf_pos_lon)[0]content["UTM_y"] = from_latlon(buf_pos_lat, buf_pos_lon)[1]# print(content)# msg.PosLon =1# # msg.PosLan =1# msg.VelE =2# # msg.posX =  388652.2938084109# # msg.posY =  4963429.720356053# msg.posX =  from_latlon(buf_pos_lat, buf_pos_lon)[0]# msg.posY =  from_latlon(buf_pos_lat, buf_pos_lon)[1]# msg.Vel = buf_vel# msg.AngleHeading = buf_angle_heading# msg.GpsNumSatsUsed = 20return contentdef main():global buf_pos_latglobal buf_pos_longlobal buf_velglobal buf_angle_headingsignal.signal(signal.SIGINT, quit)# 使用ROS參數服務器來獲取參數# serial_port_name = rospy.get_param("~serial_port", "/dev/ttyUSB0")# baud_rate = rospy.get_param("~baud_rate", 115200)serial_port_name = "/dev/ttyUSB0"baud_rate = 115200rospy.init_node("gps_imu_pub", anonymous=True)pub_location = rospy.Publisher('/ztbus/location', std_msgs.msg.String, queue_size=10)pub = rospy.Publisher("gps_imu", GpsImuInterface, queue_size = 10) msg = GpsImuInterface()while not rospy.is_shutdown():start = time.time()try:serial_port = connect_to_serial(serial_port_name, baud_rate)# print()data = read_from_port(serial_port)# print(data,"#"*8)except:print("except")continueif data :msg.PosLon =buf_pos_lonmsg.PosLat =buf_pos_latmsg.posX = from_latlon(buf_pos_lat, buf_pos_lon)[0]msg.posY = from_latlon(buf_pos_lat, buf_pos_lon)[1]msg.Vel = buf_velmsg.AngleHeading = buf_angle_headingpub_location.publish(json.dumps(data))pub.publish(msg)# rospy.loginfo("Data published to /ztbus/location topic.")prGreen("pub ok")end = time.time()interval = end -startprint('gps_interval = ', interval)# rospy.loginfo("Shutting down GPS IMU publisher node.")if __name__ == "__main__":main()

這里我的建議是將串口改成CAN口,協議也比較好確定。

本文來自互聯網用戶投稿,該文觀點僅代表作者本人,不代表本站立場。本站僅提供信息存儲空間服務,不擁有所有權,不承擔相關法律責任。
如若轉載,請注明出處:http://www.pswp.cn/bicheng/16978.shtml
繁體地址,請注明出處:http://hk.pswp.cn/bicheng/16978.shtml
英文地址,請注明出處:http://en.pswp.cn/bicheng/16978.shtml

如若內容造成侵權/違法違規/事實不符,請聯系多彩編程網進行投訴反饋email:809451989@qq.com,一經查實,立即刪除!

相關文章

2024/5/27 ARMday9SPI實驗八段數碼管顯示

main.c #include "spi.h" extern void printf(const char *fmt, ...); void delay_ms(int ms) {int i,j;for(i 0; i < ms;i)for (j 0; j < 1800; j); } //保存0-9編碼的數組 int num[10] {0xFC,0x60,0xDA,0xF2,0x66,0xB6,0x3E,0xE0,0xFE,0xF6}; int main…

2024年上半年軟件設計師試題及答案(回憶版)--選擇題

基礎知識選擇題 基礎知識選擇題 1,2,3][4,5,6][1,2,3,4,5,6] &#xff08;總&#xff1a;1分&#xff09; &#xff08;注意&#xff1a;括號內的是截止當前題目總分&#xff09; vlan不能隔絕內外網 &#xff08;2分&#xff09; 鏈路層使用交換機&#xff0c;…

智慧樹下做游戲

游戲開發工程師致力于游戲總體設計 &#xff0c;負責游戲開發工具和運營維護工具的設計與開發 &#xff0c;并配合主程序完成游戲架構及各大功能的設計、開發、調試和其他技術支持 就業方向&#xff1a; 一般有客戶端游戲開發和服務器游戲開發 客戶端開發&#xff1a; 主要負…

光伏開發是用什么工具提高效率?

隨著全球對可再生能源的日益重視&#xff0c;光伏產業作為其中的佼佼者&#xff0c;已經取得了長足的發展。然而&#xff0c;如何提高光伏開發的效率&#xff0c;降低成本&#xff0c;成為了業內關注的焦點。本文將探討光伏開發過程中所使用的工具&#xff0c;以及這些工具如何…

【軟件設計師】——11.多媒體

目錄 11.1 多媒體種類和數據壓縮 11.2 音頻 11.3 圖像 11.4 視頻 11.1 多媒體種類和數據壓縮 多媒體種類 感覺媒體&#xff1a;人接觸信息的感覺形式&#xff0c;直接作用于人的感覺器官&#xff0c;使人產生直接感覺的媒體。如視覺、聽覺、觸覺、嗅覺、味覺等 顯示媒體/表…

設計軟件有哪些?建模和造型工具篇(2),渲染100邀請碼1a12

之前介紹了一批建模工具&#xff0c;這次我們繼續介紹。 1、Forest Pack Forest Pack是由iToo Software公司開發的3ds Max插件&#xff0c;專門用于創建大規模自然環境。它提供了豐富的植被和物體庫&#xff0c;用戶可以快速創建樹木、植物、巖石等元素&#xff0c;并將它們分…

STM32HAL(一)外設驅動框架與回調函數應用

前言&#xff1a;這段時間開始學習STM32F4&#xff0c;同時為了以后的便捷性性就開始學HAL庫了 目錄 HAL庫文件 基本文件結構 API命名規則 HAL庫回調函數 HAL_ XXX _MspInit() / _MspDeInit() HAL_PPP_MspInit() HAL_PPP_MspDeInit() HAL_PPP_ProcessCpltCallback HA…

剛上手Java會踩的坑

1. 用號比較的坑 對Integer類型的兩個參數使用號比較是否相等&#xff0c;或者使用String類型的兩個變量進行比較&#xff0c;天真的認為他們是理所應當的。 其實操作只適用于基本數據類型如int , byte, boolean, short, char, long, float, double這些基本數據類型。 其它…

instanceof 關鍵字的作用

instanceof 嚴格來說是 Java 中的一個雙目運算符&#xff0c;用來測試一個對象是否為一個類的實例&#xff0c;用法為&#xff1a; boolean result obj instanceof Class其中 obj 為一個對象&#xff0c;Class 表示一個類或者一個接口&#xff0c;當 obj 為 Class 的對象&…

JavaEE-JPA(相關概念及Spring JPA)

JPA JPA 相關概念 ORM 框架 (Object Relational Mapping) 建立 Java 程序實體類與數據庫表之間的映射關系。使用 ORM 框架進行編程 Java 程序會根據開發者配置&#xff0c;在運行時自動把數據對象持久化到數據庫中&#xff0c;比直接使用 JDBC 編程更為方便和強大。 常見的 …

Android面試題之Kotlin常見集合操作技巧

本文首發于公眾號“AntDream”&#xff0c;歡迎微信搜索“AntDream”或掃描文章底部二維碼關注&#xff0c;和我一起每天進步一點點 list 創建和修改 不可變list,listOf var list listOf("a","d","f") println(list.getOrElse(3){"Unkn…

Kubernetes可視化界面之DashBoard

1.1 DashBoard Kubernetes Dashboard 是 Kubernetes 集群的一個開箱即用的 Web UI&#xff0c;提供了一種圖形化的方式來管理和監視 Kubernetes 集群中的資源。它允許用戶直接在瀏覽器中執行許多常見的 Kubernetes 管理任務&#xff0c;如部署應用、監控應用狀態、執行故障排查…

用循環神經網絡預測股價

循環神經網絡可以用來對時間序列進行預測&#xff0c;之前我們在介紹循環神經網絡RNN,LSTM和GRU的時候都用到了正弦函數預測的例子&#xff0c;其實這個例子就是一個時間序列。而在眾多的時間序列例子中&#xff0c;最普遍的就是股價的預測了&#xff0c;股價序列是一種很明顯的…

鏈表練習題

返回倒數第K個節點 快慢指針 讓快指針先走k步&#xff0c;再使得快指針與慢指針同時走一步&#xff0c;這樣沒有開額外空間&#xff0c;空間復雜度較低。 代碼實現如下&#xff1a; struct ListNode {int val;struct ListNode* next;}; int kthToLast(struct ListNode* head…

第 52 期:MySQL 半同步復制頻繁報錯

社區王牌專欄《一問一實驗&#xff1a;AI 版》全新改版歸來&#xff0c;得到了新老讀者們的關注。其中不乏對 ChatDBA 感興趣的讀者前來咨詢&#xff0c;表達了想試用體驗 ChatDBA 的意愿&#xff0c;對此我們表示感謝 &#x1f91f;。 目前&#xff0c;ChatDBA 還在最后的準備…

el-table實現合并特定列的所有行

el-table實現合并特定列的所有行 示例&#xff1a; 在這里插入圖片描述 const objectSpanMethod ({ row, column, rowIndex, columnIndex }) > {if (columnIndex 5 || columnIndex 7) {// 就是只保留第一行&#xff0c;其他直接不要&#xff0c;然后行數是列表長度if …

2024年03月 Python(一級)真題解析#中國電子學會#全國青少年軟件編程等級考試

Python等級考試(1~6級)全部真題?點這里 一、單選題(共25題,共50分) 第1題 下列哪個命令,可以將2024轉換成’2024’ 呢?( ) A:str(2024) B:int(2024) C:float(2024) D:bool(2024) 答案:A 本題考察的是str() 語句,將數字轉換成字符串用到的是str() 語句。 …

Java:IO

首 java.io中有百萬計的類&#xff0c;如何找到自己需要的部分&#xff1f; 流 IO涉及到一個“流”stream的概念&#xff0c;可以簡單理解成數據從一個源頭到一個目的地。明白數據從哪來&#xff0c;要到哪里去&#xff0c;數據流中是字節還是字符之后&#xff0c;才能找到自…

回顧下Java中的基本數據類型以及Integer與int的區別

一、Java中的基本數據類型&#xff08;Primitive Data Types&#xff09;共有八種&#xff0c;它們分別是&#xff1a; byte&#xff1a;字節型&#xff0c;用于表示8位整數&#xff0c;取值范圍從-128到127&#xff08;包括-128和127&#xff09;。 short&#xff1a;短整型&…

由于找不到d3dx9_39.dll,無法繼續執行代碼的5種解決方法

在現代科技發展的時代&#xff0c;電腦已經成為我們生活中不可或缺的一部分。然而&#xff0c;由于各種原因&#xff0c;我們可能會遇到一些電腦問題&#xff0c;其中之一就是“d3dx9_39.dll丟失”。這個問題可能會導致我們在運行某些游戲或應用程序時遇到錯誤提示&#xff0c;…