Changes from last week regarding rotation matrix
Changes from last week in regards to rotation matrix in apriltags