34 lines
1.2 KiB
C
34 lines
1.2 KiB
C
#include "kernels.h"
|
|
#include <math.h>
|
|
|
|
double native_signal(double t, double start, int stages, int cyclic, const double *data) {
|
|
double elapsed = fmax(t-start,0), duration = 0, offset = 0;
|
|
for (int i=0;i<stages;i++) duration += data[16+i];
|
|
if (cyclic && duration > 0) elapsed = fmod(elapsed,duration);
|
|
for (int i=0;i<stages;i++) {
|
|
double d = data[16+i];
|
|
if (elapsed < offset+d || i == stages-1)
|
|
return d <= 0 ? data[8+i] : data[i] + (elapsed-offset)/d*(data[8+i]-data[i]);
|
|
offset += d;
|
|
}
|
|
return data[8+stages-1];
|
|
}
|
|
|
|
double native_signal_break(double t, double end, double start, int stages,
|
|
int cyclic, const double *data) {
|
|
double duration=0, offset=0, result=end;
|
|
for (int i=0;i<stages;i++) duration += data[16+i];
|
|
for (int i=0;i<stages;i++) {
|
|
double event=start+offset;
|
|
if (cyclic && duration > 0 && event <= t) {
|
|
double cycle=fmax(0,floor((t-event)/duration)+1);
|
|
event += cycle*duration;
|
|
if (event <= t) event += duration;
|
|
}
|
|
if (event > t) result=fmin(result,event);
|
|
offset += data[16+i];
|
|
}
|
|
return result;
|
|
}
|
|
|