added sensor filter - not testesd
first p regulator implementation