1pub struct SshBinaryPacket<'a> { buf: &'a [u8], payload_start: usize, payload_len: usize }
4
5impl<'a> SshBinaryPacket<'a> {
6 pub fn parse(buf: &'a [u8]) -> Option<Self> {
7 if buf.len() < 5 { return None; }
8 let packet_len = u32::from_be_bytes([buf[0], buf[1], buf[2], buf[3]]) as usize;
9 let padding_len = buf[4] as usize;
10 let payload_len = packet_len.saturating_sub(padding_len).saturating_sub(1);
11 Some(Self { buf, payload_start: 5, payload_len })
12 }
13
14 pub fn packet_length(&self) -> u32 { u32::from_be_bytes([self.buf[0], self.buf[1], self.buf[2], self.buf[3]]) }
15 pub fn padding_length(&self) -> u8 { self.buf[4] }
16 pub fn payload(&self) -> &'a [u8] {
17 let end = (self.payload_start + self.payload_len).min(self.buf.len());
18 &self.buf[self.payload_start..end]
19 }
20}
21
22pub struct SshKexInit<'a> { payload: &'a [u8], cursor: usize }
23
24impl<'a> SshKexInit<'a> {
25 pub fn parse(buf: &'a [u8]) -> Option<Self> {
26 let pkt = SshBinaryPacket::parse(buf)?;
27 let payload = pkt.payload();
28 if payload.is_empty() || payload[0] != 20 { return None; }
29 if payload.len() < 17 { return None; }
30 Some(Self { payload, cursor: 17 }) }
32
33 pub fn cookie(&self) -> &[u8; 16] {
34 self.payload[1..17].try_into().unwrap()
35 }
36
37 fn next_name_list(&mut self) -> Vec<String> {
38 let data = &self.payload[self.cursor..];
39 if data.len() < 4 { return vec![]; }
40 let len = u32::from_be_bytes([data[0], data[1], data[2], data[3]]) as usize;
41 self.cursor += 4;
42 let end = (self.cursor + len).min(self.payload.len());
43 let list_bytes = &self.payload[self.cursor..end];
44 self.cursor = end;
45 if list_bytes.is_empty() { return vec![]; }
46 std::str::from_utf8(list_bytes).unwrap_or("").split(',').map(|s| s.trim().to_string()).filter(|s| !s.is_empty()).collect()
47 }
48
49 pub fn kex_algorithms(&mut self) -> Vec<String> { self.next_name_list() }
50 pub fn server_host_key_algorithms(&mut self) -> Vec<String> { self.next_name_list() }
51 pub fn encryption_algorithms_cts(&mut self) -> Vec<String> { self.next_name_list() }
52 pub fn encryption_algorithms_stc(&mut self) -> Vec<String> { self.next_name_list() }
53 pub fn mac_algorithms_cts(&mut self) -> Vec<String> { self.next_name_list() }
54 pub fn mac_algorithms_stc(&mut self) -> Vec<String> { self.next_name_list() }
55 pub fn compression_algorithms_cts(&mut self) -> Vec<String> { self.next_name_list() }
56 pub fn compression_algorithms_stc(&mut self) -> Vec<String> { self.next_name_list() }
57}
58
59#[cfg(test)]
60mod tests {
61 use super::*;
62
63 #[test]
64 fn parse_kex_init() {
65 let cookie = [0xAAu8; 16];
66 let name_list = b"curve25519-sha256";
67 let nl_len = name_list.len() as u32;
68 let mut payload = vec![20u8];
69 payload.extend_from_slice(&cookie);
70 for _ in 0..8 {
71 payload.extend_from_slice(&nl_len.to_be_bytes());
72 payload.extend_from_slice(name_list);
73 }
74 payload.push(0);
75 payload.extend_from_slice(&[0u8; 4]);
76
77 let packet_len = 1 + payload.len() + 4; let mut pkt = vec![];
79 pkt.extend_from_slice(&(packet_len as u32).to_be_bytes());
80 pkt.push(4); pkt.extend_from_slice(&payload);
82 pkt.extend_from_slice(&[0u8; 4]); let mut kex = SshKexInit::parse(&pkt).unwrap();
85 assert_eq!(kex.cookie(), &cookie);
86 assert_eq!(kex.kex_algorithms(), vec!["curve25519-sha256".to_string()]);
87 }
88}