cleanup, started infeed range finder

added infeed ball detect (another range finder)
added range finder to infeed class, not used yet (have to figure out how
to do this in a smart way)
changed psi slop intercept constant to negative number.
changed psi slope intercept "b" to +B (y=mx+b)