|
|
|
@ -8,17 +8,17 @@ Georgia Tech Research Corporation, Atlanta, Ga. 30332 |
|
|
|
All Rights Reserved |
|
|
|
|
|
|
|
PROJECT A-8503-405 |
|
|
|
|
|
|
|
|
|
|
|
AUTHORS |
|
|
|
|
|
|
|
AUTHORS |
|
|
|
|
|
|
|
12 Apr 1991 Harry Li |
|
|
|
|
|
|
|
|
|
|
|
MODIFICATIONS |
|
|
|
MODIFICATIONS |
|
|
|
|
|
|
|
2 Oct 1991 Jeffrey P. Murray |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
SUMMARY |
|
|
|
|
|
|
|
@ -27,12 +27,12 @@ SUMMARY |
|
|
|
oscillator) code model. |
|
|
|
|
|
|
|
|
|
|
|
INTERFACES |
|
|
|
INTERFACES |
|
|
|
|
|
|
|
FILE ROUTINE CALLED |
|
|
|
|
|
|
|
FILE ROUTINE CALLED |
|
|
|
CMmacros.h cm_message_send(); |
|
|
|
|
|
|
|
CMmacros.h cm_message_send(); |
|
|
|
|
|
|
|
CM.c void *cm_analog_alloc() |
|
|
|
void *cm_analog_get_ptr() |
|
|
|
int cm_analog_set_temp_bkpt() |
|
|
|
@ -41,7 +41,7 @@ INTERFACES |
|
|
|
REFERENCED FILES |
|
|
|
|
|
|
|
Inputs from and outputs to ARGS structure. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
NON-STANDARD FEATURES |
|
|
|
|
|
|
|
@ -51,9 +51,9 @@ NON-STANDARD FEATURES |
|
|
|
|
|
|
|
/*=== INCLUDE FILES ====================*/ |
|
|
|
|
|
|
|
#include "triangle.h" |
|
|
|
#include "triangle.h" |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*=== CONSTANTS ========================*/ |
|
|
|
|
|
|
|
@ -64,27 +64,27 @@ NON-STANDARD FEATURES |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*=== LOCAL VARIABLES & TYPEDEFS =======*/ |
|
|
|
|
|
|
|
/*=== LOCAL VARIABLES & TYPEDEFS =======*/ |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*=== FUNCTION PROTOTYPE DEFINITIONS ===*/ |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*============================================================================== |
|
|
|
|
|
|
|
FUNCTION void cm_triangle() |
|
|
|
|
|
|
|
AUTHORS |
|
|
|
AUTHORS |
|
|
|
|
|
|
|
12 Apr 1991 Harry Li |
|
|
|
|
|
|
|
MODIFICATIONS |
|
|
|
MODIFICATIONS |
|
|
|
|
|
|
|
2 Oct 1991 Jeffrey P. Murray |
|
|
|
|
|
|
|
@ -93,23 +93,23 @@ SUMMARY |
|
|
|
This function implements the triangle (controlled trianglewave |
|
|
|
oscillator) code model. |
|
|
|
|
|
|
|
INTERFACES |
|
|
|
INTERFACES |
|
|
|
|
|
|
|
FILE ROUTINE CALLED |
|
|
|
|
|
|
|
FILE ROUTINE CALLED |
|
|
|
CMmacros.h cm_message_send(); |
|
|
|
|
|
|
|
CMmacros.h cm_message_send(); |
|
|
|
|
|
|
|
CM.c void *cm_analog_alloc() |
|
|
|
void *cm_analog_get_ptr() |
|
|
|
int cm_analog_set_temp_bkpt() |
|
|
|
|
|
|
|
|
|
|
|
RETURNED VALUE |
|
|
|
|
|
|
|
|
|
|
|
Returns inputs and outputs via ARGS structure. |
|
|
|
|
|
|
|
GLOBAL VARIABLES |
|
|
|
|
|
|
|
|
|
|
|
NONE |
|
|
|
|
|
|
|
NON-STANDARD FEATURES |
|
|
|
@ -130,7 +130,7 @@ NON-STANDARD FEATURES |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I / \ * |
|
|
|
* I/------------------------------------------ * |
|
|
|
@ -145,221 +145,219 @@ NON-STANDARD FEATURES |
|
|
|
* * |
|
|
|
*****************************************************/ |
|
|
|
|
|
|
|
void cm_triangle(ARGS) /* structure holding parms, |
|
|
|
void cm_triangle(ARGS) /* structure holding parms, |
|
|
|
inputs, outputs, etc. */ |
|
|
|
{ |
|
|
|
int i; /* generic loop counter index */ |
|
|
|
int cntl_size; /* size of the control array */ |
|
|
|
int freq_size; /* size of the frequency array */ |
|
|
|
int int_cycle; /* the number of cycles rounded to the nearest int */ |
|
|
|
int freq_size; /* size of the frequency array */ |
|
|
|
int int_cycle; /* the number of cycles rounded to the nearest int */ |
|
|
|
|
|
|
|
double *x; /* pointer holds the values of the control array */ |
|
|
|
double *y; /* pointer holds the values of the freq array */ |
|
|
|
double cntl_input; /* control input */ |
|
|
|
/*double out;*/ /* output */ |
|
|
|
double dout_din; /* partial out wrt to control input */ |
|
|
|
double output_low; /* lowest point of the wave */ |
|
|
|
double output_hi; /* highest point of the wave */ |
|
|
|
double dphase; /* percent into the current phase of the cycle */ |
|
|
|
double *phase; /* instantaneous phase value */ |
|
|
|
double *phase1; /* pointer to the previous phase value */ |
|
|
|
double freq=0.0; /* actual frequency of the wave */ |
|
|
|
double d_cycle; /* duty cycle */ |
|
|
|
double *t1; /* pointer which stores time1 */ |
|
|
|
double *t2; /* pointer which stores time2 */ |
|
|
|
double *t_end; /* pointer which stores t_start */ |
|
|
|
double time1; /* time of high peak */ |
|
|
|
double time2; /* time of low peak */ |
|
|
|
double t_start; /* time of the beginning of each cycle */ |
|
|
|
double *y; /* pointer holds the values of the freq array */ |
|
|
|
double cntl_input; /* control input */ |
|
|
|
/*double out;*/ /* output */ |
|
|
|
double dout_din; /* partial out wrt to control input */ |
|
|
|
double output_low; /* lowest point of the wave */ |
|
|
|
double output_hi; /* highest point of the wave */ |
|
|
|
double dphase; /* percent into the current phase of the cycle */ |
|
|
|
double *phase; /* instantaneous phase value */ |
|
|
|
double *phase1; /* pointer to the previous phase value */ |
|
|
|
double freq=0.0; /* actual frequency of the wave */ |
|
|
|
double d_cycle; /* duty cycle */ |
|
|
|
double *t1; /* pointer which stores time1 */ |
|
|
|
double *t2; /* pointer which stores time2 */ |
|
|
|
double *t_end; /* pointer which stores t_start */ |
|
|
|
double time1; /* time of high peak */ |
|
|
|
double time2; /* time of low peak */ |
|
|
|
double t_start; /* time of the beginning of each cycle */ |
|
|
|
|
|
|
|
Mif_Complex_t ac_gain; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**** Retrieve frequently used parameters... ****/ |
|
|
|
|
|
|
|
|
|
|
|
cntl_size = PARAM_SIZE(cntl_array); |
|
|
|
freq_size = PARAM_SIZE(freq_array); |
|
|
|
cntl_size = PARAM_SIZE(cntl_array); |
|
|
|
freq_size = PARAM_SIZE(freq_array); |
|
|
|
output_low = PARAM(out_low); |
|
|
|
output_hi = PARAM(out_high); |
|
|
|
d_cycle = PARAM(duty_cycle); |
|
|
|
|
|
|
|
if(cntl_size != freq_size){ |
|
|
|
cm_message_send(triangle_array_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
if(cntl_size != freq_size) { |
|
|
|
cm_message_send(triangle_array_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
|
|
|
|
/* Allocate memory */ |
|
|
|
/* Allocate memory */ |
|
|
|
|
|
|
|
if(INIT==1){ |
|
|
|
cm_analog_alloc(INT1,sizeof(double)); |
|
|
|
cm_analog_alloc(T1,sizeof(double)); |
|
|
|
cm_analog_alloc(T2,sizeof(double)); |
|
|
|
cm_analog_alloc(T3,sizeof(double)); |
|
|
|
if(INIT==1) { |
|
|
|
cm_analog_alloc(INT1,sizeof(double)); |
|
|
|
cm_analog_alloc(T1,sizeof(double)); |
|
|
|
cm_analog_alloc(T2,sizeof(double)); |
|
|
|
cm_analog_alloc(T3,sizeof(double)); |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
if(ANALYSIS == MIF_DC){ |
|
|
|
if(ANALYSIS == MIF_DC) { |
|
|
|
|
|
|
|
/* initialize time values */ |
|
|
|
/* initialize time values */ |
|
|
|
|
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,0); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,0); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,0); |
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,0); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,0); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,0); |
|
|
|
|
|
|
|
*t1 = -1; |
|
|
|
*t2 = -1; |
|
|
|
*t_end = 0; |
|
|
|
*t1 = -1; |
|
|
|
*t2 = -1; |
|
|
|
*t_end = 0; |
|
|
|
|
|
|
|
OUTPUT(out) = output_low; |
|
|
|
PARTIAL(out,cntl_in) = 0; |
|
|
|
OUTPUT(out) = output_low; |
|
|
|
PARTIAL(out,cntl_in) = 0; |
|
|
|
|
|
|
|
}else |
|
|
|
} else if(ANALYSIS == MIF_TRAN) { |
|
|
|
|
|
|
|
if(ANALYSIS == MIF_TRAN){ |
|
|
|
/* Retrieve previous values and set equal to corresponding variables */ |
|
|
|
|
|
|
|
/* Retrieve previous values and set equal to corresponding variables */ |
|
|
|
phase = (double *) cm_analog_get_ptr(INT1,0); |
|
|
|
phase1 = (double *) cm_analog_get_ptr(INT1,1); |
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,1); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,1); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,1); |
|
|
|
|
|
|
|
phase = (double *) cm_analog_get_ptr(INT1,0); |
|
|
|
phase1 = (double *) cm_analog_get_ptr(INT1,1); |
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,1); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,1); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,1); |
|
|
|
|
|
|
|
time1 = *t1; |
|
|
|
time2 = *t2; |
|
|
|
t_start = *t_end; |
|
|
|
time1 = *t1; |
|
|
|
time2 = *t2; |
|
|
|
t_start = *t_end; |
|
|
|
|
|
|
|
/* Allocate storage for breakpoint domain & freq. range values */ |
|
|
|
/* Allocate storage for breakpoint domain & freq. range values */ |
|
|
|
|
|
|
|
x = (double *) calloc((size_t) cntl_size, sizeof(double)); |
|
|
|
if (!x) { |
|
|
|
cm_message_send(triangle_allocation_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
x = (double *) calloc((size_t) cntl_size, sizeof(double)); |
|
|
|
if (!x) { |
|
|
|
cm_message_send(triangle_allocation_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
|
|
|
|
y = (double *) calloc((size_t) freq_size, sizeof(double)); |
|
|
|
if (!y) { |
|
|
|
cm_message_send(triangle_allocation_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
y = (double *) calloc((size_t) freq_size, sizeof(double)); |
|
|
|
if (!y) { |
|
|
|
cm_message_send(triangle_allocation_error); |
|
|
|
return; |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* Retrieve x and y values. */ |
|
|
|
for (i=0; i<cntl_size; i++) { |
|
|
|
*(x+i) = PARAM(cntl_array[i]); |
|
|
|
*(y+i) = PARAM(freq_array[i]); |
|
|
|
} |
|
|
|
|
|
|
|
/* Retrieve cntl_input value. */ |
|
|
|
cntl_input = INPUT(cntl_in); |
|
|
|
/* Retrieve x and y values. */ |
|
|
|
for (i=0; i<cntl_size; i++) { |
|
|
|
*(x+i) = PARAM(cntl_array[i]); |
|
|
|
*(y+i) = PARAM(freq_array[i]); |
|
|
|
} |
|
|
|
|
|
|
|
/* Determine segment boundaries within which cntl_input resides */ |
|
|
|
/* Retrieve cntl_input value. */ |
|
|
|
cntl_input = INPUT(cntl_in); |
|
|
|
|
|
|
|
/*** cntl_input below lowest cntl_voltage ***/ |
|
|
|
if (cntl_input <= *x) { |
|
|
|
/* Determine segment boundaries within which cntl_input resides */ |
|
|
|
|
|
|
|
dout_din = (*(y+1) - *y)/(*(x+1) - *x); |
|
|
|
freq = *y + (cntl_input - *x) * dout_din; |
|
|
|
/*** cntl_input below lowest cntl_voltage ***/ |
|
|
|
if (cntl_input <= *x) { |
|
|
|
|
|
|
|
if(freq <= 0){ |
|
|
|
cm_message_send(triangle_freq_clamp); |
|
|
|
freq = 1e-16; |
|
|
|
} |
|
|
|
/* freq = *y; */ |
|
|
|
} |
|
|
|
else |
|
|
|
/*** cntl_input above highest cntl_voltage ***/ |
|
|
|
|
|
|
|
if (cntl_input >= *(x+cntl_size-1)){ |
|
|
|
dout_din = (*(y+cntl_size-1) - *(y+cntl_size-2)) / |
|
|
|
(*(x+cntl_size-1) - *(x+cntl_size-2)); |
|
|
|
freq = *(y+cntl_size-1) + (cntl_input - *(x+cntl_size-1)) * dout_din; |
|
|
|
/* freq = *(y+cntl_size-1); */ |
|
|
|
|
|
|
|
} else { /*** cntl_input within bounds of end midpoints... |
|
|
|
must determine position progressively & then |
|
|
|
calculate required output. ***/ |
|
|
|
|
|
|
|
for (i=0; i<cntl_size-1; i++) { |
|
|
|
|
|
|
|
if ((cntl_input < *(x+i+1)) && (cntl_input >= *(x+i))){ |
|
|
|
|
|
|
|
/* Interpolate to the correct frequency value */ |
|
|
|
|
|
|
|
freq = ((cntl_input - *(x+i))/(*(x+i+1) - *(x+i)))* |
|
|
|
(*(y+i+1)-*(y+i)) + *(y+i); |
|
|
|
} |
|
|
|
|
|
|
|
dout_din = (*(y+1) - *y)/(*(x+1) - *x); |
|
|
|
freq = *y + (cntl_input - *x) * dout_din; |
|
|
|
|
|
|
|
if(freq <= 0) { |
|
|
|
cm_message_send(triangle_freq_clamp); |
|
|
|
freq = 1e-16; |
|
|
|
} |
|
|
|
} |
|
|
|
/* freq = *y; */ |
|
|
|
} else |
|
|
|
/*** cntl_input above highest cntl_voltage ***/ |
|
|
|
|
|
|
|
if (cntl_input >= *(x+cntl_size-1)) { |
|
|
|
dout_din = (*(y+cntl_size-1) - *(y+cntl_size-2)) / |
|
|
|
(*(x+cntl_size-1) - *(x+cntl_size-2)); |
|
|
|
freq = *(y+cntl_size-1) + (cntl_input - *(x+cntl_size-1)) * dout_din; |
|
|
|
/* freq = *(y+cntl_size-1); */ |
|
|
|
|
|
|
|
} else { |
|
|
|
/*** cntl_input within bounds of end midpoints... |
|
|
|
must determine position progressively & then |
|
|
|
calculate required output. ***/ |
|
|
|
|
|
|
|
for (i=0; i<cntl_size-1; i++) { |
|
|
|
|
|
|
|
if ((cntl_input < *(x+i+1)) && (cntl_input >= *(x+i))) { |
|
|
|
|
|
|
|
/* Instantaneous phase is the old phase + frequency/(delta time) |
|
|
|
int_cycle is the integer value for the number cycles. */ |
|
|
|
/* Interpolate to the correct frequency value */ |
|
|
|
|
|
|
|
*phase = *phase1 + freq*(TIME - T(1)); |
|
|
|
int_cycle = *phase1; |
|
|
|
dphase = *phase1 - int_cycle; |
|
|
|
/* if the current time is greater than time1, but less than time2, |
|
|
|
calculate time2 and set the temporary breakpoint. */ |
|
|
|
if((time1 <= TIME) && (TIME <= time2)){ |
|
|
|
freq = ((cntl_input - *(x+i))/(*(x+i+1) - *(x+i)))* |
|
|
|
(*(y+i+1)-*(y+i)) + *(y+i); |
|
|
|
} |
|
|
|
|
|
|
|
time2 = T(1) + (1 - dphase)/freq; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/* Instantaneous phase is the old phase + frequency/(delta time) |
|
|
|
int_cycle is the integer value for the number cycles. */ |
|
|
|
|
|
|
|
*phase = *phase1 + freq*(TIME - T(1)); |
|
|
|
int_cycle = *phase1; |
|
|
|
dphase = *phase1 - int_cycle; |
|
|
|
/* if the current time is greater than time1, but less than time2, |
|
|
|
calculate time2 and set the temporary breakpoint. */ |
|
|
|
if((time1 <= TIME) && (TIME <= time2)) { |
|
|
|
|
|
|
|
time2 = T(1) + (1 - dphase)/freq; |
|
|
|
|
|
|
|
if(TIME < time2) { |
|
|
|
cm_analog_set_temp_bkpt(time2); |
|
|
|
} |
|
|
|
|
|
|
|
if(TIME < time2){ |
|
|
|
cm_analog_set_temp_bkpt(time2); |
|
|
|
} |
|
|
|
/* store the time that the next cycle is scheduled to begin */ |
|
|
|
t_start = time2; |
|
|
|
|
|
|
|
/* store the time that the next cycle is scheduled to begin */ |
|
|
|
t_start = time2; |
|
|
|
|
|
|
|
/* set output value */ |
|
|
|
OUTPUT(out) = output_hi - ((TIME - time1)/(time2 - time1))* |
|
|
|
(output_hi - output_low); |
|
|
|
/* set output value */ |
|
|
|
OUTPUT(out) = output_hi - ((TIME - time1)/(time2 - time1))* |
|
|
|
(output_hi - output_low); |
|
|
|
|
|
|
|
|
|
|
|
}else{ |
|
|
|
|
|
|
|
/* otherwise, calculate time1 and time2 and set their respective |
|
|
|
breakpoints */ |
|
|
|
} else { |
|
|
|
|
|
|
|
if(dphase > d_cycle){ |
|
|
|
dphase = dphase - 1.0; |
|
|
|
} |
|
|
|
/* otherwise, calculate time1 and time2 and set their respective |
|
|
|
breakpoints */ |
|
|
|
|
|
|
|
time1 = T(1) + (d_cycle - dphase)/freq; |
|
|
|
time2 = T(1) + (1 - dphase)/freq; |
|
|
|
if(dphase > d_cycle) { |
|
|
|
dphase = dphase - 1.0; |
|
|
|
} |
|
|
|
|
|
|
|
if((TIME < time1) || (T(1) == 0)){ |
|
|
|
cm_analog_set_temp_bkpt(time1); |
|
|
|
} |
|
|
|
time1 = T(1) + (d_cycle - dphase)/freq; |
|
|
|
time2 = T(1) + (1 - dphase)/freq; |
|
|
|
|
|
|
|
cm_analog_set_temp_bkpt(time2); |
|
|
|
if((TIME < time1) || (T(1) == 0)) { |
|
|
|
cm_analog_set_temp_bkpt(time1); |
|
|
|
} |
|
|
|
|
|
|
|
/* set output value */ |
|
|
|
OUTPUT(out) = output_low + ((TIME - t_start)/(time1 - t_start))* |
|
|
|
(output_hi - output_low); |
|
|
|
} |
|
|
|
cm_analog_set_temp_bkpt(time2); |
|
|
|
|
|
|
|
/* set output value */ |
|
|
|
OUTPUT(out) = output_low + ((TIME - t_start)/(time1 - t_start))* |
|
|
|
(output_hi - output_low); |
|
|
|
} |
|
|
|
|
|
|
|
PARTIAL(out,cntl_in) = 0.0; |
|
|
|
PARTIAL(out,cntl_in) = 0.0; |
|
|
|
|
|
|
|
/* set the time values for storage */ |
|
|
|
/* set the time values for storage */ |
|
|
|
|
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,0); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,0); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,0); |
|
|
|
t1 = (double *) cm_analog_get_ptr(T1,0); |
|
|
|
t2 = (double *) cm_analog_get_ptr(T2,0); |
|
|
|
t_end = (double *) cm_analog_get_ptr(T3,0); |
|
|
|
|
|
|
|
*t1 = time1; |
|
|
|
*t2 = time2; |
|
|
|
*t_end = t_start; |
|
|
|
*t1 = time1; |
|
|
|
*t2 = time2; |
|
|
|
*t_end = t_start; |
|
|
|
|
|
|
|
} else { /* Output AC Gain */ |
|
|
|
|
|
|
|
/* This model has no AC capabilities */ |
|
|
|
/* This model has no AC capabilities */ |
|
|
|
|
|
|
|
ac_gain.real = 0.0; |
|
|
|
ac_gain.real = 0.0; |
|
|
|
ac_gain.imag= 0.0; |
|
|
|
AC_GAIN(out,cntl_in) = ac_gain; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|