debuggging

got it to write. checking why it is outputing zero for the
yaw,pitch,roll