[discobrisco]

Update: with the printed cone mount as high on our robot as possible we're having no trouble with it, we did go ahead and take the largest value every 1/5th of a second to smooth outputs as well which really helped.