Changes from Krzysiek P.: added angles to rotation matrix