Adding velocity and position calculators. Tweaked cutoff frequencies. Not really working.