point_cloud_assembler: fixed output cloud format when input is organized clouds (#560)

This commit is contained in:
matlabbe
2021-03-28 00:17:53 -04:00
parent b9c7efdc8a
commit 7ab760f9e5
6 changed files with 24 additions and 3 deletions
+2 -1
View File
@@ -2149,7 +2149,8 @@ bool convertScan3dMsg(
int maxPoints,
float maxRange)
{
UASSERT(scan3dMsg.data.size() == scan3dMsg.row_step*scan3dMsg.height);
UASSERT_MSG(scan3dMsg.data.size() == scan3dMsg.row_step*scan3dMsg.height,
uFormat("data=%d row_step=%d height=%d", scan3dMsg.data.size(), scan3dMsg.row_step, scan3dMsg.height).c_str());
bool hasNormals = false;
bool hasColors = false;