Fixed a lot of math bugs, +=, i,j,k things