smaccm-mavlink: Fix receive state machine overflow.

- Should fix issues with PARAM_SET not working and perhaps other
  bugs we hadn't seen yet.
- This would have been caught by the assertions if they were
  enabled in the build.