Instead of

    let surrogate_mask = surrogate_bit << 2 | surrogate_bit << 1 | surrogate_bit;
    len &= !surrogate_mask;

    len &= surrogate_bit.wrapping_sub(1);

    len &= non_surrogate_bit.wrapping_neg();