SWTP: Fixed overflown bit logic for addition and subtraction (from Bill Beech)