humanoid_localization: Removing unused params, changing default head
motion thresholds to something more sane
Fixing error with constrainMotion flags and optimized-away assertion