Got the math working, need to put it in a seperate class