Lots of little updates to software libraries. As well as updated plane testing code to include yaw