Updated the ADD16 and SUB16 macros to fix overflow bug with INCF
see http://robotics.mcmanis.com/articles/20130117_pic_math.html
for a description of the bug