Add rotate
Refactoring rotate_z