Fixed expectedPos calculation.
Added debug output for expectedPos.
Added some debug output.

IMPORTANT:  The EX-106's report position very differently than the RX-64's when given the get_pos() command.
NEED to figure out what is going on with that because it is 100% breaking the code.