|
|
@ -256,14 +256,14 @@ static inline unsigned sacCalcIterBound (double confidence, |
|
|
|
unsigned sampleSize, |
|
|
|
unsigned sampleSize, |
|
|
|
unsigned maxIterBound); |
|
|
|
unsigned maxIterBound); |
|
|
|
static inline void hFuncRefC (float* packedPoints, float* H); |
|
|
|
static inline void hFuncRefC (float* packedPoints, float* H); |
|
|
|
static inline void sacCalcJacobianErrors(const float* restrict H, |
|
|
|
static inline void sacCalcJacobianErrors(const float* H, |
|
|
|
const float* restrict src, |
|
|
|
const float* src, |
|
|
|
const float* restrict dst, |
|
|
|
const float* dst, |
|
|
|
const char* restrict inl, |
|
|
|
const char* inl, |
|
|
|
unsigned N, |
|
|
|
unsigned N, |
|
|
|
float (* restrict JtJ)[8], |
|
|
|
float (* JtJ)[8], |
|
|
|
float* restrict Jte, |
|
|
|
float* Jte, |
|
|
|
float* restrict Sp); |
|
|
|
float* Sp); |
|
|
|
static inline float sacLMGain (const float* dH, |
|
|
|
static inline float sacLMGain (const float* dH, |
|
|
|
const float* Jte, |
|
|
|
const float* Jte, |
|
|
|
const float S, |
|
|
|
const float S, |
|
|
@ -1935,14 +1935,14 @@ inline void RHO_HEST_REFC::refine(void){ |
|
|
|
* nevertheless be vectorized if need be. |
|
|
|
* nevertheless be vectorized if need be. |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
|
|
static inline void sacCalcJacobianErrors(const float* restrict H, |
|
|
|
static inline void sacCalcJacobianErrors(const float* H, |
|
|
|
const float* restrict src, |
|
|
|
const float* src, |
|
|
|
const float* restrict dst, |
|
|
|
const float* dst, |
|
|
|
const char* restrict inl, |
|
|
|
const char* inl, |
|
|
|
unsigned N, |
|
|
|
unsigned N, |
|
|
|
float (* restrict JtJ)[8], |
|
|
|
float (* JtJ)[8], |
|
|
|
float* restrict Jte, |
|
|
|
float* Jte, |
|
|
|
float* restrict Sp){ |
|
|
|
float* Sp){ |
|
|
|
unsigned i; |
|
|
|
unsigned i; |
|
|
|
float S; |
|
|
|
float S; |
|
|
|
|
|
|
|
|
|
|
|