Matrix Calculation for Rotate + Translate