Update main.cpp

roll and yaw previously misassigned to phi and psi
In the "xyz (pitch-roll-yaw) convention," theta is pitch, psi is roll, and phi is yaw. ----->from wolfram