pub fn find(buffer: &[u8], kind: u8) -> Option<&[u8]> {
    let mut iter = buffer[8..].iter().enumerate();
    let buffer_len = buffer.len();

    loop {
        match iter.next() {
            Some((_, &len)) => match iter.next() {
                Some((i, potentialkind)) => {
                    if potentialkind == &kind {
                        if (8 + i) + len as usize > buffer_len {
                            return None;
                        } else {
                            return Some(&buffer[9 + i..8 + i + len as usize]);
                        }
                    } else if len > 0 {
                        for _ in 0..len - 1 {
                            iter.next();
                        }
                    } else {
                        return None;
                    }
                }
                _ => return None,
            },
            None => return None,
        }
    }
}

pub fn extract_for_service(service: [u8; 2], data: &[u8]) -> Option<&[u8]> {
    if data.len() > 1 {
        if service[0] == data[0] && service[1] == data[1] {
            Some(&data[2..])
        } else {
            None
        }
    } else {
        None
    }
}

#[cfg(test)]
mod test {
    use crate::ble_parser::*;
    use crate::simple_ble::BUFFER_SIZE_SCAN;

    #[test]
    fn extracts_data_for_ids_correctly() {
        let mut buf = [0; BUFFER_SIZE_SCAN];
        {
            let slice = &mut buf[8..23];
            let data = &[
                0x02, 0x02, 0x01, 0x02, 0x01, 0x03, 0x03, 0x16, 0x01, 0x02, 0x04, 0xFF, 0x01, 0x02,
                0x03,
            ];
            slice.copy_from_slice(data);
        }
        assert_eq!(find(&buf, 0x02), Some(&[0x01][0..1]));
        assert_eq!(find(&buf, 0x01), Some(&[0x03][0..1]));
        assert_eq!(find(&buf, 0x16), Some(&[0x01, 0x02][0..2]));
        assert_eq!(find(&buf, 0xFF), Some(&[0x01, 0x02, 0x03][0..3]));
    }

    #[test]
    fn doesnt_panic_for_defect_packets() {
        let mut buf = [0; BUFFER_SIZE_SCAN];
        {
            let slice = &mut buf[8..18];
            let data = &[0x02, 0x02, 0x00, 0x00, 0x00, 0x00, 0x0, 0x16, 0x01, 0x02];
            slice.copy_from_slice(data);
        }
    }

    #[test]
    fn ignores_illegal_lengths_in_packets() {
        let mut buf = [0; 11];
        {
            let slice = &mut buf[8..10];
            let data = &[0x04, 0x02];
            slice.copy_from_slice(data);
        }
        assert_eq!(find(&buf, 0xF2), None);
    }
}