Loading...
Searching...
No Matches
lwir_geolocation.c
Go to the documentation of this file.
166 if (total > lwir_calibration_max || (line_length && line[line_length - 1] != '\n' && !feof(input))) {
303 product += camera->camera_to_body[3 * row + column] * camera->camera_to_body[3 * other + column];
329 const double radial = 1 + radius2 * (camera->k1 + radius2 * (camera->k2 + radius2 * camera->k3));
352 pitch_cos * yaw_cos, roll_sin * pitch_sin * yaw_cos - roll_cos * yaw_sin, roll_cos * pitch_sin * yaw_cos + roll_sin * yaw_sin,
353 pitch_cos * yaw_sin, roll_sin * pitch_sin * yaw_sin + roll_cos * yaw_cos, roll_cos * pitch_sin * yaw_sin - roll_sin * yaw_cos,
399 const double prime_vertical = radius / sqrt(1 - eccentricity_squared * latitude_sin * latitude_sin);
400 const double earth_x = (prime_vertical + pose->altitude_ellipsoid_m) * latitude_cos * longitude_cos
403 const double earth_y = (prime_vertical + pose->altitude_ellipsoid_m) * latitude_cos * longitude_sin
406 const double earth_z = (prime_vertical * (1 - eccentricity_squared) + pose->altitude_ellipsoid_m) * latitude_sin
417 target_latitude = atan2(earth_z + eccentricity_squared * target_radius * target_sin, horizontal);
Native frame arithmetic and camera measurements; no codec or flight dependencies.
static bool parse_scalar(const char *text, double *value)
Parse a value that must be exactly one number, optionally followed by a comment.
Definition lwir_geolocation.c:73
static bool parse_number(const char **cursor, double *value)
Parse one finite number at a cursor, skipping surrounding blanks.
Definition lwir_geolocation.c:53
bool lwir_geolocation_project(double pixel_x, double pixel_y, const struct lwir_camera_geometry *camera, const struct lwir_camera_pose *pose, struct lwir_ground_point *point)
Project a native subpixel location onto the local ground plane.
Definition lwir_geolocation.c:275
static void rotate_vector(const double matrix[9], const double vector[3], double result[3])
Multiply a row-major 3x3 matrix by a 3-vector.
Definition lwir_geolocation.c:250
static bool parse_unsigned_scalar(const char *text, unsigned *value)
Parse a nonnegative decimal integer that fits in unsigned int.
Definition lwir_geolocation.c:89
static bool parse_array(const char *text, double *values, size_t count)
Parse a single-line flow array [a, b, ...] with exactly count numbers.
Definition lwir_geolocation.c:111
bool lwir_geolocation_load_calibration(const char *path, unsigned width, unsigned height, struct lwir_camera_geometry *geometry)
Load a calibration profile for one native image size.
Definition lwir_geolocation.c:137
ned_axis
Axis identities for rays and lever arms after rotation into NED.
Definition lwir_geolocation.c:43
Optional camera calibration and native pixel-to-ground geometry only.
Projection calibration in native coordinates, never display coordinates.
Definition lwir_geolocation.h:56
double k2
Dimensionless radial coefficient multiplying normalized radius to the fourth power.
Definition lwir_geolocation.h:58
double minimum_ground_cosine
Minimum normalized downward ray component; rejects unstable horizon intersections.
Definition lwir_geolocation.h:61
double k1
Dimensionless radial coefficient multiplying normalized radius squared.
Definition lwir_geolocation.h:58
double k3
Dimensionless radial coefficient multiplying normalized radius to the sixth power.
Definition lwir_geolocation.h:58
double camera_to_body[9]
Row-major rotation: camera right/down/forward to body forward/right/down.
Definition lwir_geolocation.h:59
double fx
Horizontal focal length in native pixels; must be positive.
Definition lwir_geolocation.h:57
double p1
First dimensionless tangential-distortion coefficient in OpenCV order.
Definition lwir_geolocation.h:58
double p2
Second dimensionless tangential-distortion coefficient in OpenCV order.
Definition lwir_geolocation.h:58
bool verified
Operator verification claim; loading coefficients does not establish it.
Definition lwir_geolocation.h:63
double lever_arm_body_m[3]
Navigation reference to camera origin, in body forward/right/down metres.
Definition lwir_geolocation.h:60
Observation pose; geographic angles are degrees, attitude angles radians.
Definition lwir_geolocation.h:111
double agl_m
Positive height of the navigation reference above the local ground plane.
Definition lwir_geolocation.h:112
double yaw_rad
Body yaw in radians, measured from north toward east.
Definition lwir_geolocation.h:113
double longitude_deg
Navigation reference longitude in WGS84 degrees.
Definition lwir_geolocation.h:112
double altitude_ellipsoid_m
Navigation reference height above the WGS84 ellipsoid in metres.
Definition lwir_geolocation.h:112
double pitch_rad
Body pitch in radians for the body-to-NED attitude rotation.
Definition lwir_geolocation.h:113
double roll_rad
Body roll in radians for the body-to-NED attitude rotation.
Definition lwir_geolocation.h:113
WGS84 estimate on a local horizontal plane, not a surveyed accuracy claim.
Definition lwir_geolocation.h:151
One timestamped geographic position for a replay annotation.
Definition ear_heatmap_overlay.c:79