Fix for Issue #4983 - stop state machine before restarting

Author: DavePutz

ports/raspberrypi/common-hal/rp2pio/StateMachine.c

@@ -500,6 +500,7 @@ void common_hal_rp2pio_statemachine_restart(rp2pio_statemachine_obj_t *self) {
     pio_sm_restart(self->pio, self->state_machine);
 
     uint8_t pio_index = pio_get_index(self->pio);
+    common_hal_rp2pio_statemachine_stop(self);
     uint32_t pins_we_use = _current_sm_pins[pio_index][self->state_machine];
     pio_sm_set_pins_with_mask(self->pio, self->state_machine, self->initial_pin_state, pins_we_use);
     pio_sm_set_pindirs_with_mask(self->pio, self->state_machine, self->initial_pin_direction, pins_we_use);