RP-132 Fix overflow

I know this is logically simple stuff, but I'd really like to see a simple gtest added to the package which exercises the `updateJointsFromHardware` function and proves that the rollover behaviour is correct in both directions, etc.