Remove all hardcoded bit shifts for float to int conversions

[kirkscheper]

Recently, many hardcoded position float to int (and vice-versa) were added with the hybrid guidance, this should be removed. We should also ensure that there are no hardcoded conversions in other files for positio, speed, accel or angles. The helper functions should be used instead to allow us to change the resolution of those int's on the fly which is super useful for indoor flight for example (position resolution is preferred over range, e.g simple odometry).