Commenting out the right inverse conversion function that is working.
Quick visual reformatting.
Optimized axisAngle2rotMat() a little, attempted a few other things to see if I could fix the formula with no success.