Added more tests

Added integer: multiplication and division and floating point: addition/subtraction. 
Refactored code to increase compiler optimization while still preventing premature optimization of calculations.