rem --- Semesteroppgave MUS4860 - Kandidatnr: 360
rem --- Bruker kun tre innganger på CUI32. Bruker Savitsky-Golay filter før
rem --- data sendes. Denne ser på trenden i de siste 7 sensoravlesningene,
rem --- vekter disse forskjellig og tar deretter gjennomsnittet. Deretter
rem --- blir gjennomsnittet sendt trådløst til nodeid 2. Implementasjonen
rem --- av filteret er hentet fra http://overtone-labs.ning.com/

dim an0 as pin an0 for analog input
dim an1 as pin an1 for analog input
dim an2 as pin an2 for analog input

dim an3 as pin an3 for analog input

dim a0 as remote on nodeid 2
dim b0 as remote on nodeid 2
dim c0 as remote on nodeid 2
dim d0 as remote on nodeid 2

dim a[7],b[7],c[7], d[7]

configure timer 0 for 5 ms
on timer 0 do gosub filter
while 1 do
endwhile
sub filter
let a[0] = a[1]
let a[1] = a[2]
let a[2] = a[3]
let a[3] = a[4]
let a[4] = a[5]
let a[5] = a[6]
let a[6] = an0
let a0 = (-2*a[0]+3*a[1]+6*a[2]+7*a[3]+6*a[4]+3*a[5]+-2*a[6])/21
let b[0] = b[1]
let b[1] = b[2]
let b[2] = b[3]
let b[3] = b[4]
let b[4] = b[5]
let b[5] = b[6]
let b[6] = an1
let b0 = (-2*b[0]+3*b[1]+6*b[2]+7*b[3]+6*b[4]+3*b[5]+-2*b[6])/21
let c[0] = c[1]
let c[1] = c[2]
let c[2] = c[3]
let c[3] = c[4]
let c[4] = c[5]
let c[5] = c[6]
let c[6] = an2
let c0 = (-2*c[0]+3*c[1]+6*c[2]+7*c[3]+6*c[4]+3*c[5]+-2*c[6])/21
let d[0] = d[1]
let d[1] = d[2]
let d[2] = d[3]
let d[3] = d[4]
let d[4] = d[5]
let d[5] = d[6]
let d[6] = an3
let d0 = (-2*d[0]+3*d[1]+6*d[2]+7*d[3]+6*d[4]+3*d[5]+-2*d[6])/21

endsub