Skinned and increased threshold of correctness by adding pitch, yaw, and roll. As well as a length comparison