Benewake(北醒) TF-Luna/TFmini-S/TF03 串口版本雷达在树莓派 Raspberry Pi 上的运用(Python)


英文版本请参考参考以下链接
链接: https://pan.baidu.com/s/1D0n11Mz2odnOAju-TNJ5kQ 提取码: xf5u

本文介绍了如何将北醒单点雷达TFluna/TFmini-S/TF02-pro/TF03与 Raspberry Pi 4B 连接,它应该适用于所有其他版本的 Raspberry Pi。

1.最终用户手上有树莓派和TF-Luna
2.树莓派上安装了操作系统(在Raspbian version 10 buster上测试)
3.串口已经开启
4.安装了Python2或3 5. 编写脚本需要 Python 编辑器。 我在我的 RasPi 上安装了 Thonny。

注:如果已安装完整版 Raspbian,则完整版中包含所有必需的软件包。

Raspberry Pi 接口定义

下图是Raspberry Pi开发板的接口定义:
在这里插入图片描述
在这里插入图片描述
我们使用串行引脚将 TF系列 与 Raspberry Pi 连接起来。 Pin-8 (TXD) 和 Pin-10 (RXD) 。 由于TF-Luna的工作电压为5V,因此可以将2和6或4和6脚用作电源。

正确连接所需的定制电缆:

如果我们看TF-Luna的连接器,它是GH1.25-4P连接器。 另一方面,Raspberry Pi 有针头。 因此,我们需要一根电缆,其一侧具有 4P 1.55MM 条形连接器(也称为水平贴片插座),另一侧具有杜邦母连接器,用于将其插入 Raspberry Pi。 下图显示了为此目的定制的电缆。
在这里插入图片描述

接线示意图:

下图显示了 TF-Luna 与 Raspberry Pi 的连接图。
在这里插入图片描述
需要注意的是,如果您将更多设备连接到您的树莓派,那么强烈建议使用大电流电源,因为默认适配器只有 2A 的电流容量。 因此,请根据整个系统的电流要求来选择电源。 实际的连接设置可以在下图中看到。
在这里插入图片描述

Python code:

在本节中,我们将讨论用于从 TF-Luna 读取数据的 Python 代码的主要部分。 下表显示了TF-Luna使用的串口协议和数据格式:
在这里插入图片描述
在这里插入图片描述
按照上述数据序列,我们将使用 Python 从 TF-Luna 获取字节。 首先,我们需要安装可以使用 pip installer 完成的串口库(适用于 Python2 和 3):
在这里插入图片描述
成功安装库后,就可以编写脚本并导入串口库了。

import serial

创建 Serial 类的对象并传递必要的参数(串口和波特率):

ser = serial.Serial("/dev/ttyAMA0", 115200)

main 函数从这里开始,它搜索端口是否打开并调用函数 read_data():

if __name__ == "__main__":
	try:
		if ser.isOpen() == False:
			ser.open()
		read_data()
	except KeyboardInterrupt(): # ctrl + c in terminal.
		if ser != None:
			ser.close()
			print("program interrupted by the user")

函数 read_data() 检查字节,进行一些必要的字节移位,然后在终端中打印数据:

# we define a new function that will get the data from LiDAR and publish it
def read_data():
	while True:
		counter = ser.in_waiting # count the number of bytes of the serial port
		if counter > 8:
		bytes_serial = ser.read(9)
		ser.reset_input_buffer()
		if bytes_serial[0] == 0x59 and bytes_serial[1] == 0x59: # python3
		print("TF-Luna python3 portion")
		distance = bytes_serial[2] + bytes_serial[3]*256
		strength = bytes_serial[4] + bytes_serial[5]*256
		temperature = bytes_serial[6] + bytes_serial[7]*256 # For TFLuna
		temperature = (temperature/8) - 256
		print("Distance:"+ str(distance))
		print("Strength:" + str(strength))
		if temperature != 0:
			print("Chip Temperature:" + str(temperature))
		ser.reset_input_buffer()
	if bytes_serial[0] == "Y" and bytes_serial[1] == "Y":
		distL = int(bytes_serial[2].encode("hex"), 16)
		distH = int(bytes_serial[3].encode("hex"), 16)
		stL = int(bytes_serial[4].encode("hex"), 16)
		stH = int(bytes_serial[5].encode("hex"), 16)
		distance = distL + distH*256
		strength = stL + stH*256
		tempL = int(bytes_serial[6].encode("hex"), 16)
		tempH = int(bytes_serial[7].encode("hex"), 16)
		temperature = tempL + tempH*256
		temperature = (temperature/8) - 256
		print("TF-Luna python2 portion")
		print("Distance:"+ str(distance) + "\n")
		print("Strength:" + str(strength) + "\n")
		print("Chip Temperature:" + str(temperature) + "\n")
		ser.reset_input_buffer()

这段代码有两部分; 第一部分与 Python3 兼容(上半部分),第二部分与 Python2 兼容(下半部分)。 对于不同的字节位置,请参考表三。
激光雷达测得的距离如下图所示。
在这里插入图片描述

完整代码

import serial
ser = serial.Serial("/dev/ttyAMA0", 115200)
# we define a new function that will get the data from LiDAR and publish it
def read_data():
    while True:
        counter = ser.in_waiting # count the number of bytes of the serial port
        if counter > 8:
            bytes_serial = ser.read(9)
            ser.reset_input_buffer()
            
            if bytes_serial[0] == 0x59 and bytes_serial[1] == 0x59: # python3
                print("TF-Luna python3 portion")
                distance = bytes_serial[2] + bytes_serial[3]*256
                strength = bytes_serial[4] + bytes_serial[5]*256
                temperature = bytes_serial[6] + bytes_serial[7]*256 # For TFLuna
                temperature = (temperature/8) - 256
                print("Distance:"+ str(distance))
                print("Strength:" + str(strength))
                if temperature != 0:
                    print("Chip Temperature:" + str(temperature))
                ser.reset_input_buffer()
                
            if bytes_serial[0] == "Y" and bytes_serial[1] == "Y":
                distL = int(bytes_serial[2].encode("hex"), 16)
                distH = int(bytes_serial[3].encode("hex"), 16)
                stL = int(bytes_serial[4].encode("hex"), 16)
                stH = int(bytes_serial[5].encode("hex"), 16)
                distance = distL + distH*256
                strength = stL + stH*256
                tempL = int(bytes_serial[6].encode("hex"), 16)
                tempH = int(bytes_serial[7].encode("hex"), 16)
                temperature = tempL + tempH*256
                temperature = (temperature/8) - 256
                print("TF-Luna python2 portion")
                print("Distance:"+ str(distance) + "\n")
                print("Strength:" + str(strength) + "\n")
                print("Chip Temperature:" + str(temperature) + "\n")
                ser.reset_input_buffer()
if __name__ == "__main__":
    try:
        if ser.isOpen() == False:
            ser.open()
        read_data()
    except KeyboardInterrupt():
        if ser != None:
            ser.close()
            print("program interrupted by the user")
  • 0
    点赞
  • 14
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
北醒TFmini-S可以通过以下步骤连接到飞控1. 首先,确保你已搭建好了PX开发环境。你可以参考引用中的链接来搭建PX4开发环境。 2. 在飞控中添加TFmini的驱动程序。你可以参考引用中的链接来添加TFmini的驱动程序。 3. 设置TFmini-S的相关参数。在用户自定义设置中,你可以根据需要调整TFmini-S的最大水平速度触发值(EKF2_RNG_A_VMAX)和最大高度触发值(EKF2_RNG_A_HMAX)。默认值分别为1m/s和5m。你可以根据实际需求进行调整。 4. 在飞控的设置中开启TFmini-S。在设置菜单中选择Sensors,然后选择SENS_TFMINI_CFG选项,并选择TELEM2。确保你已经正确选择了TFmini-S的端口。 请注意,如果你在设置菜单中找不到SENS_TFMINI_CFG选项,请参考引用中的链接,并按照官方教程中的说明进行操作。 通过以上步骤,你就可以成功将北醒TFmini-S接入到飞控中了。<span class="em">1</span><span class="em">2</span><span class="em">3</span> #### 引用[.reference_title] - *1* [Benewake(北醒) TF-Luna/TFmini-S/TF03 串口版本雷达树莓派 Raspberry Pi 上的运用Python)](https://blog.csdn.net/zoran_wu/article/details/118903172)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 50%"] - *2* *3* [Benewake(北醒) 单点TF系列雷达在开源飞控PX4上的运用](https://blog.csdn.net/zoran_wu/article/details/109469995)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 50%"] [ .reference_list ]
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值