参考にどうぞ
http://vivi.dyndns.org/w/%A5%D3%A5%C3%A5%C8%A5%DE%A5%C3%A5%D7%B2%F3%C5%BE
回転して計算した後に逆回転して戻すの？