【仓库物资识别】三、根据激光雷达的光束计算Y坐标,与X和Z构成完整的点云数据

之前leader给了一个txt文档,里面只包含了x 和 z的坐标

如表,第一列是x轴(x的个数为1492个),然后每一个x点都对应着217个z坐标,现在需要根据激光雷达散发出的光束角度和激光雷达距离地面的高度,得出y轴的坐标,不过可以接受的是,y轴上对应的也是坐标值固定的217个点。

部分代码如下:

//创建坐标点 x y z 
typedef struct Point
{
	double x;
	double y;
	double z;
};

//按照字符串之间的空格进行字符切割
void split(const string& s, vector<string>& elems, char delim = ' ')
int main()
{
	//计算y坐标,存入vector之中
	vector<float> PointY;
	float m_dbLaserHeight = 12.13f; //扫描仪高度
	float fAngleResolution = 0.1667f; //扫描角度分辨率
	float fAngleScanRange = 18.0f;    //扫描角度范围
	unsigned int nAngleMax = (unsigned int)ceil((90 + fAngleScanRange) / fAngleResolution);
	unsigned int nAngleMin = (unsigned int)ceil((90 - fAngleScanRange) / fAngleResolution);
	for (unsigned int n = nAngleMin; n <= nAngleMax; n++)
	{
		double dbAngle = n * fAngleResolution;
		double db90Angle = (90 - dbAngle)*(3.1415926f / 180);  //角度到弧长的转化
		double acty = 10.19 - m_dbLaserHeight*tan(db90Angle);
		PointY.push_back(acty);
	}

}

之前博客里的一篇文章只是显示了x和z轴的点云数据:

下面是添加了y轴数据的点云:

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值