Add CORDIC_sqrt func.

We can caculate a sqrt operation!