Merge pull request #467 from wdawson/overhaul

Falling/Standup/Stiffness
Changed MMKF to have 2 filters, choose between the two of them based on the velocity estimates
Cleaned up for pull request
Merge remote-tracking branch 'northern-bites/overhaul' into overhaul