Add full_scale parameter and apply to offset

Add a full_scale parameter instead of the hard-coded FULL_SCALE define.

Apply full_scale to offset_msg and rot_offset_msg to get messages approx. normalized between [-1,1].