math fix
Merge pull request #36 from Doomhammer458/master

math fix