Crtp update

I was wrong about the problem before. The static_casts don't cause any problems. I just had to update the assignment operator for so3/se3! Sorry it took me this long to dive in.