Ändrat i Wait_for_90_degree_rotation och lite till.