Add integer cordic and testing.. still some sort of bug to chase..