created lp filter, updated gyrotest to implement lp

lp includes 1 simple filter y)n = x)n + x) n-1