#include <Karto.h>
Public Member Functions | |
| void | ComputeOffsets (LocalizedRangeScan *pScan, kt_double angleCenter, kt_double angleOffset, kt_double angleResolution) |
| const std::vector< kt_double > & | GetAngles () const |
| const LookupArray * | GetLookupArray (kt_int32u index) const |
| GridIndexLookup () | |
| GridIndexLookup (Grid< T > *pGrid) | |
| virtual | ~GridIndexLookup () |
Private Member Functions | |
| void | ComputeOffsets (kt_int32u angleIndex, kt_double angle, const Pose2Vector &rLocalPoints, LocalizedRangeScan *pScan) |
| void | DestroyArrays () |
| template<class Archive > | |
| void | serialize (Archive &ar, const unsigned int version) |
| void | SetSize (kt_int32u size) |
Private Attributes | |
| std::vector< kt_double > | m_Angles |
| kt_int32u | m_Capacity |
| Grid< T > * | m_pGrid |
| LookupArray ** | m_ppLookupArray |
| kt_int32u | m_Size |
Friends | |
| class | boost::serialization::access |
Create lookup tables for point readings at varying angles in grid. For each angle, grid indexes are calculated for each range reading. This is to speed up finding best angle/position for a localized range scan
Used heavily in mapper and localizer.
In the localizer, this is a huge speed up for calculating possible position. For each particle, a probability is calculated. The range scan is the same, but all grid indexes at all possible angles are calculated. So when calculating the particle probability at a specific angle, the index table is used to look up probability in probability grid!
|
inline |
|
inline |
|
inlinevirtual |
|
inlineprivate |
|
inline |
Compute lookup table of the points of the given scan for the given angular space
| pScan | the scan |
| angleCenter | |
| angleOffset | computes lookup arrays for the angles within this offset around angleStart |
| angleResolution | how fine a granularity to compute lookup arrays in the angular space |
|
inlineprivate |
|
inline |
|
inline |
|
inlineprivate |
|
inlineprivate |
|
friend |
|
private |
|
private |
|
private |
|
private |
|
private |