Casting a negative value??

[westfw]

Are you sure you're passing the right "hi-byte" and "low byte" ?
Make some test code that prints all of "high byte", "low byte", and the calculated "distance."