Move rp_math.h to util