![]() |
ModelSpace
|
Measurement class to calculate focal plane angles from tgt and observer state. More...
#include <CalcFocalPlaneAngles.hpp>
Public Member Functions | |
int | calculateMeasurements (T time, const std::array< T, 6 > &tar_state, const std::array< T, 3 > &obs_state, std::array< T, 2 > &out_measurements) |
Function to focal plane angles. | |
virtual int | calculateMeasurements (T time, const std::array< T, N > &tar_state, const std::array< T, O > &obs_state, std::array< T, M > &out_measurements) |
Function to calculate range and range rate from current state of system. | |
Measurement class to calculate focal plane angles from tgt and observer state.
This function calculates focal plane angles as (alpha, beta) for a given target in an image frame using the known position of the imager and target. The focal plane angles are defined as follows: alpha = atan([xtgt - xobs]/[ztgt - zobs]) beta = atan([ytgt - yobs]/[ztgt - zobs])
Where target and observer states are differenced to generate the target state in the focal frame. The focal frame is defined as: Centered in the center of the reference image X is "up" in the image Y is "right" in the image Z is "into" the image completing the right hand frame
|-------------------—| | x^ | | |-->y | | | |-------------------—|
int clockwerk::CalcFocalPlaneAngles< T >::calculateMeasurements | ( | T | time, |
const std::array< T, 6 > & | tar_state, | ||
const std::array< T, 3 > & | obs_state, | ||
std::array< T, 2 > & | out_measurements | ||
) |
Function to focal plane angles.
time | The reference time (unused) |
tar_state | The target reference state [x, y, z, vx, vy, vz] |
obs_state | The observer reference state [x, y, z] representing camera position |
out_measurements | Implicit return of [alpha, beta] |
|
inlinevirtualinherited |
Function to calculate range and range rate from current state of system.
time | The reference time |
tar_state | The target reference state |
obs_state | The observer reference state |
out_measurements | Implicit return of measurements based on time, state |