简介:这份资源是面向C#开发者与机器人导航爱好者的思岚A1激光雷达测试程序,帮助读者理解并运用该硬件设备完成环境感知与数据采集。程序围绕串口通信接口展开,涉及波特率、校验位、停止位等参数设置,并通过DTR信号控制设备启停;同时实现激光雷达扫描数据的接收与解析,包括解码、噪声过滤和格式转换,最终借助GDI+或WPF绘制自制极坐标雷达图,将点云数据以距离、角度、颜色和密度直观呈现,便于调试算法与演示系统功能。资源包为rar格式,共37个文件,以13个cs源码文件为核心,辅以config配置、resx资源、exe可执行程序及sln解决方案等,整体约89KB,结构紧凑便于快速上手。目前已有409人学习下载,适合希望掌握激光雷达串口通信、数据解析与可视化展示的开发者参考实践。
1. 思岚A1激光雷达C#测试程序:从串口拿到第一帧点云
手里有一台思岚 A1 激光雷达,USB 转串口插上电脑,设备管理器里能看到 COM 口,但接下来怎么用 C# 把数据读出来、画成一张能看的点云图?这是很多做 C# 上位机的朋友拿到雷达后的第一个卡点。思岚 A1 走的是串口通信,波特率 115200,输出的是自定义的二进制帧协议,不是现成的 JSON 或文本,所以你必须自己解析帧头、校验、角度和距离字段。这篇笔记就围绕「思岚A1激光雷达C#测试程序」这个目标,把协议解析、串口读取、点云换算、界面刷新这条链路拆开讲清楚。适合有 C# 基础、做过 WinForm 或 WPF 上位机、手头正好有一台 A1 或类似串口雷达的工程师。读完你能自己写一个能跑、能看、能继续扩展的测试程序,而不是停在「串口打开了但不知道读出来的是什么」。
2. 思岚A1的帧协议与C#串口读取选型
2.1 为什么不能直接 ReadLine,而要按字节解析
思岚 A1 的通信协议是二进制帧,不是文本行。它的每一帧以固定的帧头开始,后面跟采样点数据,最后是校验和。如果你用 SerialPort.ReadLine() 或者按字符串去读,会遇到两个问题:一是二进制数据里可能出现 0x0A、0x0D 这类被当成换行的字节,导致一帧被切断;二是 ReadLine 会等到超时才返回,实时性完全没法保证。常见做法是设置 SerialPort.ReadBufferSize 大一点,然后用 Read(byte[], int, int) 按字节流读取,自己维护一个缓冲区,在里面找帧头、判断帧长、校验、提取采样点。
A1 的一帧结构大致是这样的:帧头两个字节(0xAA 0x55),接着是包类型、采样点数量、起始角度、结束角度,然后每个采样点用两个字节表示距离和置信度,最后两个字节是校验和。校验方式是把前面所有字节按 16 位累加取反。这个结构决定了你不能假设一次 Read 就能拿到完整一帧,必须做粘包和半包处理。
提示:不同固件版本的 A1 在采样点数量和角度字段的编码上可能有细微差别,拿到雷达后先用官方工具或串口助手抓一段原始数据,确认帧头和帧长再写解析代码,能省掉大量猜测时间。
2.2 串口参数与读取线程的配置
在 C# 里打开串口,关键参数就几个:端口名、波特率 115200、数据位 8、停止位 1、无校验。这些在 A1 的规格里是固定的,不要随意改。真正影响稳定性的,是读取方式。我一般会用一个独立线程或 Task 去循环读串口,而不是在 UI 线程里等数据。读到的字节先塞进一个 List<byte> 或环形缓冲区,然后交给解析逻辑去消费。
下面是一个最小可用的串口读取骨架,重点看缓冲区和读取循环的处理方式:
using System;
using System.IO.Ports;
using System.Collections.Generic;
using System.Threading;
public class LidarSerialReader
{
private SerialPort _port;
private List<byte> _buffer = new List<byte>();
private Thread _readThread;
private volatile bool _running;
public void Open(string portName)
{
_port = new SerialPort(portName, 115200, Parity.None, 8, StopBits.One);
_port.ReadBufferSize = 4096;
_port.Open();
_running = true;
_readThread = new Thread(ReadLoop) { IsBackground = true };
_readThread.Start();
}
private void ReadLoop()
{
byte[] temp = new byte[1024];
while (_running)
{
try
{
int n = _port.Read(temp, 0, temp.Length);
if (n > 0)
{
lock (_buffer)
{
for (int i = 0; i < n; i++) _buffer.Add(temp[i]);
}
ParseBuffer();
}
}
catch (TimeoutException) { /* 读超时正常,继续 */ }
catch (Exception ex) { /* 记录日志,决定是否退出 */ }
}
}
private void ParseBuffer()
{
// 解析逻辑在下一节展开
}
}
这段代码里, ReadBufferSize 设成 4096 是为了减少驱动层丢数据的概率。读取线程用 IsBackground = true ,这样主程序退出时不会因为线程没结束而卡住。 _buffer 用 lock 保护,因为解析可能发生在读取线程里,而后续如果要把点云传给 UI 线程,还会涉及跨线程访问。 Read 的超时异常要单独捕获,串口读超时是正常现象,不应该当成错误把线程干掉。
参数上唯一需要你根据实际情况调的,是 Read 的缓冲区大小和读取循环里每次处理的节奏。如果发现丢帧严重,先把 ReadBufferSize 加大,再检查是不是解析逻辑太慢导致缓冲区堆积。另一个容易忽略的点是串口的 DtrEnable 和 RtsEnable ,A1 一般不需要流控,保持默认即可,但如果你用的 USB 转串口芯片比较特殊,可能需要手动设一下。
2.3 帧同步:在字节流里找到 0xAA 0x55
解析的第一步是帧同步。你拿到的是一串连续的字节,里面可能从任意位置开始,也可能包含半帧。做法是在缓冲区里从头扫描,找到 0xAA 后面紧跟 0x55 的位置,然后判断从这个位置开始是否够一帧的长度。如果不够,就保留这部分数据等下一批字节;如果够,就取出整帧做校验。
这里有个血泪经验:不要假设帧头一定在缓冲区下标 0 的位置。串口刚打开时,你很可能从一帧的中间开始接收,前几个字节是上一帧的尾巴。所以扫描必须从当前位置往后找,找到帧头后把前面的垃圾字节丢掉。校验失败时,也不能简单地把整帧丢掉就完事,因为有可能帧头是数据里偶然出现的 0xAA 0x55 ,真正的帧头在后面。稳妥的做法是校验失败时只往前移动一个字节,重新找帧头,而不是跳过整帧长度。
private void ParseBuffer()
{
lock (_buffer)
{
int index = 0;
while (index <= _buffer.Count - 2)
{
// 找帧头
if (_buffer[index] != 0xAA || _buffer[index + 1] != 0x55)
{
index++;
continue;
}
// 假设帧长固定,实际要根据包类型判断
int frameLen = GetFrameLength(_buffer, index);
if (frameLen <= 0 || index + frameLen > _buffer.Count)
break; // 数据不够,等下一批
byte[] frame = _buffer.GetRange(index, frameLen).ToArray();
if (CheckSum(frame))
{
HandleFrame(frame);
index += frameLen;
}
else
{
index++; // 校验失败,只移动一个字节重新找
}
}
// 丢掉已经处理过的字节
if (index > 0) _buffer.RemoveRange(0, index);
}
}
GetFrameLength 需要根据包类型字段来返回不同长度,A1 的采样帧和健康状态帧长度不一样。 CheckSum 按协议做累加取反校验。 HandleFrame 里再去解析角度和距离。这个结构的好处是,无论串口一次给你多少字节、从哪个位置开始,最终都能收敛到正确的帧边界上。
3. 把原始字节变成点云坐标
3.1 角度与距离字段的解析
一帧采样数据里,每个采样点包含距离和置信度。距离字段是 16 位,低 15 位是距离值,单位毫米,最高位是置信度标志。角度不是每个点单独存的,而是通过起始角度、结束角度和采样点数量算出来的。A1 的一帧里,起始角度和结束角度各占两个字节,单位是 0.01 度。用结束角度减起始角度,除以采样点数量减一,就得到每个点之间的角度增量。
解析时要注意字节序。思岚的协议里,多字节字段是小端序,也就是低字节在前。C# 里用 BitConverter.ToUInt16 时要注意它默认按系统字节序,在 x86/x64 上就是小端,所以直接可以用。但如果你把代码移植到其他平台,最好手动拼字节,避免踩字节序的坑。
private void HandleFrame(byte[] frame)
{
// 假设 frame[2] 是包类型,frame[3] 是采样点数量
int sampleCount = frame[3];
ushort startAngleRaw = BitConverter.ToUInt16(frame, 4);
ushort endAngleRaw = BitConverter.ToUInt16(frame, 6);
double startAngle = startAngleRaw / 100.0;
double endAngle = endAngleRaw / 100.0;
double angleStep = sampleCount > 1
? (endAngle - startAngle) / (sampleCount - 1)
: 0;
var points = new List<Point2D>();
int offset = 8;
for (int i = 0; i < sampleCount; i++)
{
ushort raw = BitConverter.ToUInt16(frame, offset + i * 2);
bool valid = (raw & 0x8000) == 0; // 最高位为 0 表示距离有效
double distanceMm = raw & 0x7FFF;
double angle = startAngle + angleStep * i;
if (valid && distanceMm > 0)
{
double rad = angle * Math.PI / 180.0;
points.Add(new Point2D
{
X = distanceMm * Math.Cos(rad),
Y = distanceMm * Math.Sin(rad)
});
}
}
OnPointsReceived(points);
}
这里 raw & 0x8000 判断置信度, raw & 0x7FFF 取距离。角度用度转弧度后算 X、Y。 OnPointsReceived 是一个事件或回调,把点云传给 UI 层。注意 sampleCount 和偏移量要根据实际协议确认,不同固件可能把包类型和采样点数量放在不同位置,写之前一定用串口助手抓一帧对着数。
3.2 坐标换算与界面刷新的线程问题
点云算出来是雷达坐标系下的 X、Y,单位毫米。要在 WinForm 的 PictureBox 或 WPF 的 Canvas 上画,需要做一次坐标变换:把雷达原点映射到控件中心,Y 轴翻转(屏幕坐标 Y 向下),再按比例缩放。缩放比例根据你想显示的范围来定,比如显示 6 米范围,控件宽 600 像素,那比例就是 0.1 像素每毫米。
线程问题是 C# 上位机里最容易翻车的地方。串口读取在后台线程,点云数据也在后台线程产生,但控件只能在 UI 线程更新。直接跨线程访问控件会抛 InvalidOperationException 。正确做法是用 Control.Invoke 或 Dispatcher.Invoke 把更新操作切回 UI 线程。如果点云刷新频率很高,比如每秒几十帧,每帧都 Invoke 会导致 UI 卡顿。我一般会做一个简单的双缓冲:后台线程把最新点云写到一个共享变量,UI 线程用定时器按固定频率(比如 30 帧每秒)去取最新数据重绘,这样既保证流畅,又不会让消息队列爆掉。
private List<Point2D> _latestPoints = new List<Point2D>();
private readonly object _pointsLock = new object();
private void OnPointsReceived(List<Point2D> points)
{
lock (_pointsLock)
{
_latestPoints = points;
}
}
private void UiTimer_Tick(object sender, EventArgs e)
{
List<Point2D> snapshot;
lock (_pointsLock)
{
snapshot = _latestPoints;
}
DrawPoints(snapshot);
}
_latestPoints 用锁保护,UI 定时器取一份快照再画。 DrawPoints 里做坐标变换和绘制。定时器间隔设 33 毫秒左右,对应 30 帧每秒,对测试程序来说足够。如果你发现画面撕裂或闪烁,可以开双缓冲,WinForm 里设 DoubleBuffered = true ,WPF 里用 CompositionTarget.Rendering 也行。
4. 避坑与排查:串口雷达测试程序最常见的五个翻车点
4.1 现象:串口打开成功但一直接收不到数据
原因通常有三个:一是端口号选错了,设备管理器里看到的 COM 口不一定就是雷达的,有些 USB 转串口会虚拟出多个;二是波特率不对,A1 是 115200,但如果你之前改过固件或用了别的雷达,可能不是这个值;三是雷达没有转起来,A1 上电后需要发送启动指令才会开始输出数据,有些版本默认上电就转,有些需要先发命令。
解决:先用串口助手以 115200 打开对应 COM 口,看有没有原始字节流。如果没有,换端口、换波特率试。如果有字节但 C# 里读不到,检查是不是被其他程序占用了串口。A1 的启动指令一般是特定的字节序列,查一下你手上版本的协议手册,在打开串口后发一次。
4.2 现象:能收到数据但解析出来的点云是乱的
原因多半是帧同步没做好,或者帧长判断错了。如果帧头扫描逻辑有 bug,把数据里的 0xAA 0x55 当成帧头,后面取出来的角度和距离全是错的。另一个常见原因是字节序搞反了,角度和距离字段读出来是高位在前,数值大得离谱。
解决:在解析代码里加日志,把每一帧的原始字节打印出来,和串口助手抓到的对比。确认帧头位置、包类型、采样点数量、起始角度这几个字段的偏移量。如果角度值超过 360 或者距离值超过几万,基本就是字节序或偏移错了。
4.3 现象:点云画出来只有一半或者有断弧
原因通常是丢帧。串口读取速度跟不上雷达输出速度,或者解析逻辑太慢导致缓冲区溢出。A1 每秒输出的帧数不少,如果每帧都做大量计算或者频繁 Invoke UI,很容易丢。
解决:把串口 ReadBufferSize 加大,读取线程里只做缓冲区追加,解析放到单独线程或定时处理。UI 刷新用快照方式,不要每帧都 Invoke。如果还是丢,降低雷达转速(如果支持)或者换质量更好的 USB 转串口线。
4.4 现象:程序运行一段时间后串口读异常,必须重启
原因是串口读取线程里发生了未捕获的异常,线程退出了,但主程序不知道。或者 USB 转串口芯片在长时间高速数据下出现驱动层问题。
解决:读取循环里用 try-catch 包住,异常时记录日志并尝试重新打开串口,而不是让线程静默退出。另外, SerialPort 的 Read 在拔掉 USB 时会抛 IOException ,要单独处理。如果频繁出现,考虑换 FTDI 或 CP210x 芯片的转串口线,兼容性更好。
4.5 现象:校验和一直对不上
原因是校验算法写错了,或者帧长取错了导致校验范围不对。A1 的校验是把帧头到校验和之前的所有字节按 16 位累加,取反加一,或者直接取反,不同版本可能不一样。
解决:拿一帧已知正确的数据,手动算一遍校验,和帧里的校验字节对比。确认是累加取反还是累加和。另外注意校验范围是否包含帧头,有些协议不包含帧头,只校验数据部分。
5. 进阶:用极坐标直方图快速验证数据质量
测试程序跑通之后,下一步不是急着做 SLAM 或建图,而是先验证数据质量。一个很实用的技巧是画极坐标直方图:把一帧里所有点的距离按角度分桶,每个角度区间统计距离的均值和方差。如果雷达正常,直方图应该是一条平滑的曲线,方差很小;如果某个角度区间方差突然变大,说明那个方向有干扰或者雷达窗口脏了。
具体做法是在解析出点云后,不急着画 X、Y,而是先按角度 0 到 360 度分成 360 个桶,每个桶里放对应角度的距离值。然后算每个桶的均值和标准差。用 C# 的 Dictionary<int, List<double>> 就能做,角度取整作为 key。画的时候用 ZedGraph 或直接自绘,横轴角度,纵轴距离均值,误差棒表示标准差。
private void BuildHistogram(List<Point2D> points)
{
var buckets = new Dictionary<int, List<double>>();
foreach (var p in points)
{
double angle = Math.Atan2(p.Y, p.X) * 180.0 / Math.PI;
if (angle < 0) angle += 360;
int key = (int)angle;
if (!buckets.ContainsKey(key)) buckets[key] = new List<double>();
buckets[key].Add(Math.Sqrt(p.X * p.X + p.Y * p.Y));
}
foreach (var kv in buckets)
{
double mean = kv.Value.Average();
double std = Math.Sqrt(kv.Value.Average(v => (v - mean) * (v - mean)));
// 画到图表上
}
}
这个直方图能帮你快速判断雷达是不是正常工作、有没有遮挡、安装是否水平。如果某个角度区间一直没数据,检查是不是雷达被挡住或者那个角度的采样有问题。如果标准差很大,可能是环境里有反光或透明物体。
另一个进阶技巧是把连续多帧的点云叠加显示,用不同颜色表示时间先后,这样能直观看到运动物体的轨迹。但叠加之前一定要确认时间戳对齐,A1 的帧里可能没有绝对时间戳,你需要用接收时间做近似。我一般会在 HandleFrame 里记一个 DateTime.Now ,叠加时按时间差着色。
最后说一个我自己的习惯:每次改完解析代码,先不接 UI,直接控制台输出前 10 帧的角度和距离,和串口助手抓的原始数据对一遍。这个笨办法帮我省掉了无数次在 UI 上瞎找问题的时间。雷达测试程序的核心不是界面多漂亮,而是数据链路每一环都可验证。希望帮到你。
330



被折叠的 条评论
为什么被折叠?



