Added rotation direction. Maybe made final angles more accurate. Imprecision with final postion when rotating and translating at the same time.