fixed FSM. Added Yaw. Added release Frame