Standardize parameter parsing

Particularly, `moveit_servo/src/servo_parameters.cpp` should be standardized.

I think it's a good idea to ignore int's getting cast as doubles, but throw a warning if the parameter type does not match expected otherwise.