fixed CORDIC algo, but theree's still an error in there...