Removed duplicate sin + cos calls when rotating a pose

[MarkWez]

Even ignoring the likely performance gain of not calling sin/cos twice, this is also arguably clearer to read and more closely matches implementation in other languages.