added yaw angle, fixed environment sensor, added 30Hz Update Rate