Small function to set model matrix
Yaw pitch roll rotation matrix

Also a pretty printer