Implement CORDIC_cos, CORDIC_sin

CORDIC_cos & CORDIC_sin are implemented in this commit.
But these functions can't calculate the solution, because float_to_fixed & fixed_to_float funcs.

So, I should implement FTF funcs in next commit.
fix bugs.