firewire: fw-sbp2: add a boundary check