Math refactor

Refactored math functionality into k7jtoMath class, to ease readability
for the Scouts.