SortPosition

Sort points based on their position of grip frame.

Member Variables

gripPointOrdering

std::vector< std::array< float, 4 > >, default: \{std::array<float, 4>\{0.F, 0.F, 1.F, 0.F\}\} JSON Type: (optional) array of arrays (direction + epsilon) +Requirement: May contain n arrays of length 4 (3 * orientation + 1 * epsilon) The orientation part of the vector contains a direction to be sorted along, the epsilon part of the vector states how much deviation along one row defined by a vector may occur. The sorting/definition of rows is going to be in the same order as they appear in the array. The vectors are defined in the camera base. This means that sorting along z, y, x, would first fill up a row along x, then go the he next row one up in y, the finally go to the next layer in z. Positive x direction is from right to left, positive y direction is from bottom to top, positive z direction is from camera to scene. epsilon is corresponding to value of cosine(theta). -→ epsilon = 0.1 -→ angle tolerance = arccos(0.1) = 84.3 degrees

referenceFrame

Transform::BaseFrame, default: \{ JSON Type: string [CAMERA|ROBOT] coordinate systems used for sorting

sortType

SortSelection

Enumerations

Table 1. SortSelection
Value Description

None

Position

sort by position of grip pose

Direction

sort by orientation of grip pose