Skip to content

Commit

Permalink
Merge pull request #1 from prclibo/fix_correction
Browse files Browse the repository at this point in the history
maybe a fix for the offset correction computation
  • Loading branch information
Casey Goodlett committed Feb 12, 2015
2 parents f0e7c91 + d51d45f commit 0b4cc92
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions VelodyneHDL/vtkVelodyneHDLReader.cxx
Original file line number Diff line number Diff line change
Expand Up @@ -940,14 +940,14 @@ void vtkVelodyneHDLReader::vtkInternal::PushFiringData(const unsigned char laser
}

double distanceM = laserReturn->distance * 0.002 + correction->distanceCorrection;
double xyDistance = distanceM * correction->cosVertCorrection - correction->sinVertOffsetCorrection;
double xyDistance = distanceM * correction->cosVertCorrection;

// Compute raw position
double pos[3] =
{
xyDistance * sinAzimuth - correction->horizontalOffsetCorrection * cosAzimuth,
xyDistance * cosAzimuth + correction->horizontalOffsetCorrection * sinAzimuth,
distanceM * correction->sinVertCorrection + correction->cosVertOffsetCorrection
distanceM * correction->sinVertCorrection + correction->vertOffsetCorrection
};

// Apply sensor transform
Expand Down

0 comments on commit 0b4cc92

Please sign in to comment.