Function mask6

fn mask6(
    p2: i32,
    p1: i32,
    p0: i32,
    q0: i32,
    q1: i32,
    q2: i32,
    shift: usize,
) -> usize