Added needed Writing functions to old lidar

This commit is contained in:
Daniel Santos-Olivan 2020-07-15 17:30:38 +02:00 committed by DSantosO
parent fdb3553b2c
commit e93f9d328d
1 changed files with 11 additions and 0 deletions

View File

@ -51,6 +51,17 @@ namespace s11n {
point(x, y, z), intensity{intensity} { }
LidarDetection(geom::Location p, float intensity) :
point(p), intensity{intensity} { }
void WritePlyHeaderInfo(std::ostream& out) const{
out << "property float32 x\n" \
"property float32 y\n" \
"property float32 z\n" \
"property float32 I\n";
}
void WriteDetection(std::ostream& out) const{
out << point.x << ' ' << point.y << ' ' << point.z << ' ' << intensity;
}
};
class LidarMeasurement {