int
p4_pix2foc(
const unsigned int naxes,
const distortion_lookup_t **lookup, /* [NAXES] */
const unsigned int nelem,
const double* pix, /* [NAXES][nelem] */
double *foc /* [NAXES][nelem] */) {
assert(pix);
assert(foc);
if (pix != foc) {
memcpy(foc, pix, sizeof(double) * naxes * nelem);
}
return p4_pix2deltas(naxes, lookup, nelem, pix, foc);
}
int pipeline_pix2foc(
pipeline_t* pipeline,
const unsigned int ncoord,
const unsigned int nelem,
const double* const pixcrd /* [ncoord][nelem] */,
double* foc /* [ncoord][nelem] */) {
static const char* function = "pipeline_pix2foc";
int has_det2im;
int has_sip;
int has_p4;
const double * input = NULL;
double * tmp = NULL;
int status = 1;
struct wcserr **err;
assert(nelem == 2);
assert(pixcrd != foc);
if (pipeline == NULL || pixcrd == NULL || foc == NULL) {
return WCSERR_NULL_POINTER;
}
err = &(pipeline->err);
has_det2im = pipeline->det2im[0] != NULL || pipeline->det2im[1] != NULL;
has_sip = pipeline->sip != NULL;
has_p4 = pipeline->cpdis[0] != NULL || pipeline->cpdis[1] != NULL;
if (has_det2im) {
if (has_sip || has_p4) {
tmp = malloc(ncoord * nelem * sizeof(double));
if (tmp == NULL) {
status = wcserr_set(
PIP_ERRMSG(WCSERR_MEMORY), "Memory allocation failed");
goto exit;
}
memcpy(tmp, pixcrd, sizeof(double) * ncoord * nelem);
status = p4_pix2deltas(2, (void*)pipeline->det2im, ncoord, pixcrd, tmp);
if (status) {
wcserr_set(PIP_ERRMSG(WCSERR_NULL_POINTER), "NULL pointer passed");
goto exit;
}
input = tmp;
memcpy(foc, input, sizeof(double) * ncoord * nelem);
} else {
memcpy(foc, pixcrd, sizeof(double) * ncoord * nelem);
status = p4_pix2deltas(2, (void*)pipeline->det2im, ncoord, pixcrd, foc);
if (status) {
wcserr_set(PIP_ERRMSG(WCSERR_NULL_POINTER), "NULL pointer passed");
goto exit;
}
}
} else {
/* Copy pixcrd to foc as a starting point. The "deltas" functions
below will undistort from there */
memcpy(foc, pixcrd, sizeof(double) * ncoord * nelem);
input = pixcrd;
}
if (has_sip) {
status = sip_pix2deltas(pipeline->sip, 2, ncoord, input, foc);
if (status) {
wcserr_copy(pipeline->sip->err, pipeline->err);
goto exit;
}
}
if (has_p4) {
status = p4_pix2deltas(2, (void*)pipeline->cpdis, ncoord, input, foc);
if (status) {
wcserr_set(PIP_ERRMSG(WCSERR_NULL_POINTER), "NULL pointer passed");
goto exit;
}
}
status = 0;
exit:
free(tmp);
return status;
}
