1#include "DawnFcDistortionMap.h"
2#include "CameraFocalPlaneMap.h"
7 DawnFcDistortionMap::DawnFcDistortionMap(
Camera *parent,
double k1,
double zDirection) :
CameraDistortionMap(parent, zDirection) {
17 offsetSqrd = ux * ux + uy * uy;
40 offsetSqrd = dy * dy + dx * dx;
41 double guess_dx, guess_dy;
42 double guess_ux, guess_uy;
48 guess_ux = dx / (1.0 + p_k1 * offsetSqrd);
49 guess_uy = dy / (1.0 + p_k1 * offsetSqrd);
51 offsetSqrd = guess_uy * guess_uy + guess_ux * guess_ux;
53 guess_dx = guess_ux * (1.0 + p_k1 * offsetSqrd);
54 guess_dy = guess_uy * (1.0 + p_k1 * offsetSqrd);
57 if(abs(guess_dy - dy) > delta) {
61 if(abs(guess_dx - dx) > delta) {
67 if(numAttempts > 20) {
Distort/undistort focal plane coordinates.
double p_focalPlaneX
Distorted focal plane x.
double p_undistortedFocalPlaneX
Undistorted focal plane x.
double p_undistortedFocalPlaneY
Undistorted focal plane y.
double p_focalPlaneY
Distorted focal plane y.
bool SetFocalPlane(const double ux, const double uy)
Compute undistorted focal plane x/y.
bool SetUndistortedFocalPlane(const double dx, const double dy)
Compute distorted focal plane x/y.
This is free and unencumbered software released into the public domain.
Namespace for the standard library.