BUG: yaw cannot be set

[OliEfr]

new_commands should be checking for yaw_rate instead of yaw

[OliEfr]

            if "yaw_rate" in new_commands:
                new_velocity_commands[2] = new_commands["yaw_rate"]