Fixed ifndefs for RTOD and DTOR in math_util
Merge branch 'master' of http://github.com/hymanc-umich/botlab