I just did a quick glance at first but now I see you are extracting the low and high bytes from Pos_ms. Why not just use the lowbyte and highbyte functions on your Pos_ms integer.
I just did a quick glance at first but now I see you are extracting the low and high bytes from Pos_ms. Why not just use the lowbyte and highbyte functions on your Pos_ms integer.