I think the rotation formulas are right

But i'm not sure