scripts: mavsetp: added local accel; corrected how the OFFBOARD mode is switched

Also, added yaw angle and rate setpoints.