Implement 3d rotation matrix -> axis angle conversion.

Cornercases are not handled correctly yet.