cmath1.c, allow cph (continuous phase) for clipped vectors
This commit is contained in:
parent
1aa086ca71
commit
5be49ce8cf
|
|
@ -76,14 +76,31 @@ cx_cph(void *data, short int type, int length, int *newlength, short int *newtyp
|
||||||
{
|
{
|
||||||
double *d = alloc_d(length);
|
double *d = alloc_d(length);
|
||||||
ngcomplex_t *cc = (ngcomplex_t *) data;
|
ngcomplex_t *cc = (ngcomplex_t *) data;
|
||||||
int i;
|
int i, j;
|
||||||
|
|
||||||
*newlength = length;
|
*newlength = length;
|
||||||
*newtype = VF_REAL;
|
*newtype = VF_REAL;
|
||||||
if (type == VF_COMPLEX) {
|
if (type == VF_COMPLEX) {
|
||||||
double last_ph = cph(cc[0]);
|
/* check for clipped values (NaNs) */
|
||||||
d[0] = radtodeg(last_ph);
|
double last_ph;
|
||||||
for (i = 1; i < length; i++) {
|
for (j = 0; j < length; j++) {
|
||||||
|
if (isnan(cc[j].cx_real)) {
|
||||||
|
d[j] = NAN;
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
/* get the first non-NaN as reference */
|
||||||
|
last_ph = cph(cc[j]);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (j == length - 1) {
|
||||||
|
fprintf(cp_err, "Error: Cannot calculate phase values due to NaN vector values\n");
|
||||||
|
return ((void *) d);
|
||||||
|
}
|
||||||
|
|
||||||
|
d[j] = radtodeg(last_ph);
|
||||||
|
for (i = j + 1; i < length; i++) {
|
||||||
double ph = cph(cc[i]);
|
double ph = cph(cc[i]);
|
||||||
last_ph = ph - (2*M_PI) * floor((ph - last_ph)/(2*M_PI) + 0.5);
|
last_ph = ph - (2*M_PI) * floor((ph - last_ph)/(2*M_PI) + 0.5);
|
||||||
d[i] = radtodeg(last_ph);
|
d[i] = radtodeg(last_ph);
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue