Edited getDriveMatrix01 to include cos(angleOfIncidenceFactor). Added getDriveMatrix10.m to do yaw.