Less magic numbers

Added todo
Reduced math done during the program, made variables on start
Formatting cleanup