Fixed optimized cordic code