int main(){
const int NP=256; // Number of points in curve
const int N1=17, N2=N1*N1; // Size of graph
float pixels[N2]; // Accumulation buffer
CSine<> osc(1./NP);
SineR<> oscAM;
for(int k=2; k<5; ++k){
for(int j=0; j<3; ++j){
mem::zero(pixels, N2);
float w = j*0.3 + 0.2; // "petalness" factor
oscAM.set(k/(float)NP, w);
for(int i=0; i<NP; ++i){
Complex<> c = osc() * (1-w + oscAM());
int ix = posToInd( c.r, N1);
int iy = posToInd(-c.i, N1);
pixels[iy*N1 + ix] += 0.1;
}
print2D(pixels, N1, N1);
printf("\n");
}}
}
void FilterTwoPole::test() {
float updateInterval = .1;
float nextupdateTime = 1e-6*float(micros());
float inputValue = 0;
FilterTwoPole osc( 0.2, 4, 0);
while( true ) {
float now = 1e-6*float(micros());
// switch input values on a 20 second cycle
if( round(now/50.0)-(now/50.0) < 0 )
inputValue = 100;
else
inputValue = 150;
osc.input(inputValue);
analogWrite(10,osc.output() ); // hardcoded the dial pin
if( now > nextupdateTime ) {
nextupdateTime += updateInterval;
Serial.print("inputValue: "); Serial.print( inputValue );
Serial.print("\t output: "); Serial.print( osc.output() );
Serial.println();
}
}
}
void test_notch() {
// WhiteNoise osc;
Sine osc(600);
// LineSegment cutoffSweep(3, 2000.0, 200.0);
Sine sweep;
sweep.set_frequency(1);
sweep.set_scale(550);
sweep.set_offset(600);
Notch lpfilter(osc, osc.sample_rate(), sweep, 0.99995F );
logMsg("playing band-reject (notch) filter...");
run_test(lpfilter);
logMsg("notch test done.");
}
void
emulate(void)
{
Rune buf[BUFS+1];
int i;
int n;
int c;
int operand[10];
int noperand;
int savex, savey, saveattr, saveisgraphics;
int isgraphics;
int g0set, g1set;
int dch;
isgraphics = 0;
g0set = 'B'; /* US ASCII */
g1set = 'B'; /* US ASCII */
savex = savey = 0;
yscrmin = 0;
yscrmax = ymax;
saveattr = 0;
saveisgraphics = 0;
/* set initial tab stops to DEC-standard 8-column spacing */
for(c=0; (c+=8)<nelem(tabcol);)
tabcol[c] = 1;
for (;;) {
if (y > ymax) {
x = 0;
newline();
}
buf[0] = get_next_char();
buf[1] = '\0';
switch(buf[0]) {
case '\000':
case '\001':
case '\002':
case '\003':
case '\004':
case '\005':
case '\006':
goto Default;
case '\007': /* bell */
ringbell();
break;
case '\010': /* backspace */
if (x > 0)
--x;
break;
case '\011': /* tab to next tab stop; if none, to right margin */
for(c=x+1; c<nelem(tabcol) && !tabcol[c]; c++)
;
if(c < nelem(tabcol))
x = c;
else
x = xmax;
break;
case '\012': /* linefeed */
case '\013':
case '\014':
newline();
if (ttystate[cs->raw].nlcr)
x = 0;
break;
case '\015': /* carriage return */
x = 0;
if (ttystate[cs->raw].crnl)
newline();
break;
case '\016': /* SO: invoke G1 char set */
isgraphics = (isdigit(g1set));
break;
case '\017': /* SI: invoke G0 char set */
isgraphics = (isdigit(g0set));
break;
case '\020': /* DLE */
case '\021': /* DC1 */
case '\022': /* XON */
case '\023': /* DC3 */
case '\024': /* XOFF */
case '\025': /* NAK */
case '\026': /* SYN */
case '\027': /* ETB */
case '\030': /* CAN: cancel escape sequence, display checkerboard (not implemented) */
case '\031': /* EM */
case '\032': /* SUB: same as CAN */
goto Default;
;
/* ESC, \033, is handled below */
case '\034': /* FS */
case '\035': /* GS */
case '\036': /* RS */
case '\037': /* US */
break;
case '\177': /* delete: ignored */
break;
case '\033':
switch(dch = get_next_char()){
/*
* 1 - graphic processor option on (no-op; not installed)
*/
case '1':
break;
/*
* 2 - graphic processor option off (no-op; not installed)
*/
case '2':
break;
/*
* 7 - save cursor position.
*/
case '7':
//print("save\n");
savex = x;
savey = y;
saveattr = attr;
saveisgraphics = isgraphics;
break;
/*
* 8 - restore cursor position.
*/
case '8':
//print("restore\n");
x = savex;
y = savey;
attr = saveattr;
isgraphics = saveisgraphics;
break;
/*
* c - Reset terminal.
*/
case 'c':
print("resetterminal\n");
cursoron = 1;
ttystate[cs->raw].nlcr = 0;
break;
/*
* D - active position down a line, scroll if at bottom margin.
* (Original VT100 had a bug: tracked new-line/line-feed mode.)
*/
case 'D':
if(++y > yscrmax) {
y = yscrmax;
scroll(yscrmin+1, yscrmax+1, yscrmin, yscrmax);
}
break;
/*
* E - active position to start of next line, scroll if at bottom margin.
*/
case 'E':
x = 0;
if(++y > yscrmax) {
y = yscrmax;
scroll(yscrmin+1, yscrmax+1, yscrmin, yscrmax);
}
break;
/*
* H - set tab stop at current column.
* (This is cursor home in VT52 mode (not implemented).)
*/
case 'H':
if(x < nelem(tabcol))
tabcol[x] = 1;
break;
/*
* M - active position up a line, scroll if at top margin..
*/
case 'M':
if(--y < yscrmin) {
y = yscrmin;
scroll(yscrmin, yscrmax, yscrmin+1, yscrmin);
}
break;
/*
* Z - identification. the terminal
* emulator will return the response
* code for a generic VT100.
*/
case 'Z':
Ident:
sendnchars(7, "\033[?1;2c"); /* VT100 with AVO option */
// sendnchars(5, "\033[?6c"); /* VT102 (insert/delete-char, etc.) */
break;
/*
* < - enter ANSI mode
*/
case '<':
break;
/*
* > - set numeric keypad mode on (not implemented)
*/
case '>':
break;
/*
* = - set numeric keypad mode off (not implemented)
*/
case '=':
break;
/*
* # - Takes a one-digit argument
*/
case '#':
switch(get_next_char()){
case '3': /* Top half of double-height line */
case '4': /* Bottom half of double-height line */
case '5': /* Single-width single-height line */
case '6': /* Double-width line */
case '7': /* Screen print */
case '8': /* Fill screen with E's */
break;
}
break;
/*
* ( - switch G0 character set
*/
case '(':
g0set = get_next_char();
break;
/*
* - switch G1 character set
*/
case ')':
g1set = get_next_char();
break;
/*
* Received left bracket.
*/
case '[':
/*
* A semi-colon or ? delimits arguments.
*/
memset(operand, 0, sizeof(operand));
operand[0] = number(buf, &i);
noperand = 1;
while(buf[0] == ';' || buf[0] == '?'){
if(noperand < nelem(operand)){
noperand++;
operand[noperand-1] = number(buf, nil);
} else
number(buf, nil);
}
/*
* do escape2 stuff
*/
switch(dch = buf[0]){
/*
* c - same as ESC Z: what are you?
*/
case 'c':
goto Ident;
/*
* g - various tabstop manipulation
*/
case 'g':
switch(operand[0]){
case 0: /* clear tab at current column */
if(x < nelem(tabcol))
tabcol[x] = 0;
break;
case 3: /* clear all tabs */
memset(tabcol, 0, sizeof tabcol);
break;
}
break;
/*
* l - clear various options.
*/
case 'l':
if(noperand == 1){
switch(operand[0]){
case 20: /* set line feed mode */
ttystate[cs->raw].nlcr = 1;
break;
case 30: /* screen invisible (? not supported through VT220) */
break;
}
}else while(--noperand > 0){
switch(operand[noperand]){
case 1: /* set cursor keys to send ANSI functions: ESC [ A..D */
break;
case 2: /* set VT52 mode (not implemented) */
break;
case 3: /* set 80 columns */
setdim(-1, 80);
break;
case 4: /* set jump scrolling */
break;
case 5: /* set normal video on screen */
break;
case 6: /* set origin to absolute */
originrelative = 0;
x = y = 0;
break;
case 7: /* reset auto-wrap mode */
wraparound = 0;
break;
case 8: /* reset auto-repeat mode */
break;
case 9: /* reset interlacing mode */
break;
case 25: /* text cursor off (VT220) */
cursoron = 0;
break;
}
}
break;
/*
* s - some dec private stuff. actually [ ? num s, but we can't detect it.
*/
case 's':
break;
/*
* h - set various options.
*/
case 'h':
if(noperand == 1){
switch(operand[0]){
default:
break;
case 20: /* set newline mode */
ttystate[cs->raw].nlcr = 0;
break;
case 30: /* screen visible (? not supported through VT220) */
break;
}
}else while(--noperand > 0){
switch(operand[noperand]){
default:
break;
case 1: /* set cursor keys to send application function: ESC O A..D */
break;
case 2: /* set ANSI */
break;
case 3: /* set 132 columns */
setdim(-1, 132);
break;
case 4: /* set smooth scrolling */
break;
case 5: /* set screen to reverse video (not implemented) */
break;
case 6: /* set origin to relative */
originrelative = 1;
x = 0;
y = yscrmin;
break;
case 7: /* set auto-wrap mode */
wraparound = 1;
break;
case 8: /* set auto-repeat mode */
break;
case 9: /* set interlacing mode */
break;
case 25: /* text cursor on (VT220) */
cursoron = 1;
break;
}
}
break;
/*
* m - change character attrs.
*/
case 'm':
setattr(noperand, operand);
break;
/*
* n - request various reports
*/
case 'n':
switch(operand[0]){
case 5: /* status */
sendnchars(4, "\033[0n"); /* terminal ok */
break;
case 6: /* cursor position */
sendnchars(sprint((char*)buf, "\033[%d;%dR",
originrelative ? y+1 - yscrmin : y+1, x+1), (char*)buf);
break;
}
break;
/*
* q - turn on list of LEDs; turn off others.
*/
case 'q':
break;
/*
* r - change scrolling region. operand[0] is
* min scrolling region and operand[1] is max
* scrolling region.
*/
case 'r':
yscrmin = 0;
yscrmax = ymax;
switch(noperand){
case 2:
yscrmax = operand[1]-1;
if(yscrmax > ymax)
yscrmax = ymax;
case 1:
yscrmin = operand[0]-1;
if(yscrmin < 0)
yscrmin = 0;
}
x = 0;
y = yscrmin;
break;
/*
* x - report terminal parameters
*/
case 'x':
sendnchars(20, "\033[3;1;1;120;120;1;0x");
break;
/*
* y - invoke confidence test
*/
case 'y':
break;
/*
* z - line spacing
*/
case 'z':
break;
/*
* A - cursor up.
*/
case 'e':
case 'A':
fixops(operand);
y -= operand[0];
if(y < yscrmin)
y = yscrmin;
olines -= operand[0];
if(olines < 0)
olines = 0;
break;
/*
* B - cursor down
*/
case 'B':
fixops(operand);
y += operand[0];
if(y > yscrmax)
y=yscrmax;
break;
/*
* C - cursor right
*/
case 'a':
case 'C':
fixops(operand);
x += operand[0];
/*
* VT-100-UG says not to go past the
* right margin.
*/
if(x > xmax)
x = xmax;
break;
/*
* D - cursor left
*/
case 'D':
fixops(operand);
x -= operand[0];
if(x < 0)
x = 0;
break;
/*
* G - cursor to column
*/
case '\'':
case 'G':
fixops(operand);
x = operand[0] - 1;
if(x > xmax)
x = xmax;
break;
/*
* H and f - cursor motion. operand[0] is row and
* operand[1] is column, origin 1.
*/
case 'H':
case 'f':
fixops(operand+1);
x = operand[1] - 1;
if(x > xmax)
x = xmax;
/* fallthrough */
/*
* d - cursor to line n (xterm)
*/
case 'd':
fixops(operand);
y = operand[0] - 1;
if(originrelative){
y += yscrmin;
if(y > yscrmax)
y = yscrmax;
}else{
if(y > ymax)
y = ymax;
}
break;
/*
* J - clear some or all of the display.
*/
case 'J':
switch (operand[0]) {
/*
* operand 2: whole screen.
*/
case 2:
clear(Rpt(pt(0, 0), pt(xmax+1, ymax+1)));
break;
/*
* operand 1: start of screen to active position, inclusive.
*/
case 1:
clear(Rpt(pt(0, 0), pt(xmax+1, y)));
clear(Rpt(pt(0, y), pt(x+1, y+1)));
break;
/*
* Default: active position to end of screen, inclusive.
*/
default:
clear(Rpt(pt(x, y), pt(xmax+1, y+1)));
clear(Rpt(pt(0, y+1), pt(xmax+1, ymax+1)));
break;
}
break;
/*
* K - clear some or all of the line.
*/
case 'K':
switch (operand[0]) {
/*
* operand 2: whole line.
*/
case 2:
clear(Rpt(pt(0, y), pt(xmax+1, y+1)));
break;
/*
* operand 1: start of line to active position, inclusive.
*/
case 1:
clear(Rpt(pt(0, y), pt(x+1, y+1)));
break;
/*
* Default: active position to end of line, inclusive.
*/
default:
clear(Rpt(pt(x, y), pt(xmax+1, y+1)));
break;
}
break;
/*
* P - delete character(s) from right of cursor (xterm)
*/
case 'P':
fixops(operand);
i = x + operand[0];
draw(screen, Rpt(pt(x, y), pt(xmax+1, y+1)), screen, nil, pt(i, y));
clear(Rpt(pt(xmax-operand[0], y), pt(xmax+1, y+1)));
break;
/*
* @ - insert blank(s) to right of cursor (xterm)
*/
case '@':
fixops(operand);
i = x + operand[0];
draw(screen, Rpt(pt(i, y), pt(xmax+1, y+1)), screen, nil, pt(x, y));
clear(Rpt(pt(x, y), pt(i, y+1)));
break;
/*
* X - erase character(s) at cursor and to the right (xterm)
*/
case 'X':
fixops(operand);
i = x + operand[0];
clear(Rpt(pt(x, y), pt(i, y+1)));
break;
/*
* L - insert a line at cursor position (VT102 and later)
*/
case 'L':
fixops(operand);
for(i = 0; i < operand[0]; ++i)
scroll(y, yscrmax, y+1, y);
break;
/*
* M - delete a line at cursor position (VT102 and later)
*/
case 'M':
fixops(operand);
for(i = 0; i < operand[0]; ++i)
scroll(y+1, yscrmax+1, y, yscrmax);
break;
/*
* S,T - scroll up/down (xterm)
*/
case 'T':
fixops(operand);
for(i = 0; i < operand[0]; ++i)
scroll(yscrmin, yscrmax, yscrmin+1, yscrmin);
break;
case 'S':
fixops(operand);
for(i = 0; i < operand[0]; ++i)
scroll(yscrmin+1, yscrmax+1, yscrmin, yscrmin);
break;
case '=': /* ? not supported through VT220 */
number(buf, nil);
switch(buf[0]) {
case 'h':
case 'l':
break;
}
break;
/*
* Anything else we ignore for now...
*/
default:
print("unknown escape2 '%c' (0x%x)\n", dch, dch);
break;
}
break;
/*
* Collapse multiple '\033' to one.
*/
case '\033':
peekc = '\033';
break;
/* OSC escape */
case ']':
osc();
break;
/*
* Ignore other commands.
*/
default:
print("unknown command '%c' (0x%x)\n", dch, dch);
break;
}
break;
default: /* ordinary char */
Default:
if(isgraphics && buf[0] < nelem(gmap) && gmap[buf[0]])
buf[0] = gmap[buf[0]];
/* line wrap */
if (x > xmax){
if(wraparound){
x = 0;
newline();
}else{
continue;
}
}
n = 1;
c = 0;
while (!cs->raw && host_avail() && x+n<=xmax && n<BUFS
&& (c = get_next_char())>=' ' && c<'\177') {
buf[n++] = c;
c = 0;
}
buf[n] = 0;
drawstring(pt(x, y), buf, attr);
x += n;
peekc = c;
break;
}
}
}
