[math] some cleanup and fixes for fixedpoint functions

- int32_sqrt returns an unsigned int
- int32_sqrt takes an unsigned int as argument
- state interface: speed_norm_i is unsigned
- unsigned nav_leg_length
- fix int32_vec2_normalize