Skip to main content
. 2021 Dec 12;21(24):8308. doi: 10.3390/s21248308
Algorithm 3. Algorithm for Creating Recording Hypothesis from Frontier Point Data
GenerateFPointHypothesis(PCD, F, N, drec, minc, stepc,):
SH← Ø
H← Ø
forf in F
  position ← PCD[f] + drec * N[f]
  Z = −N[f]
  X = cross([0, 0, 1], Z)
  Y = cross(Z, X)
  R = [X, Y, Z]
  orientation ← quaterion(R)
  SH ← insert (position, orientation)
noc← minc + length(F)/stepc
H← KMeans(SH, noc)