Attitude

add library attitude to read RPY Angle