sin/cos cordic partially working