|
| 1 | +use at_commands::{builder::CommandBuilder, parser::CommandParser}; |
| 2 | +use atat::{self, AtatCmd}; |
| 3 | +use core::{borrow::BorrowMut, ffi::c_void, marker::PhantomData}; |
| 4 | +use esp_idf_hal::{delay::TickType, uart::UartDriver}; |
| 5 | + |
| 6 | +use crate::{ |
| 7 | + handle::RawHandle, |
| 8 | + netif::{EspNetif, NetifStack}, |
| 9 | + sys::*, |
| 10 | +}; |
| 11 | + |
| 12 | +pub struct PppNetif<'d, T> |
| 13 | +where |
| 14 | + T: BorrowMut<UartDriver<'d>>, |
| 15 | +{ |
| 16 | + serial: T, |
| 17 | + base: esp_netif_driver_base_t, |
| 18 | + netif: EspNetif, |
| 19 | + _d: PhantomData<&'d ()>, |
| 20 | +} |
| 21 | + |
| 22 | +impl<'d, T> PppNetif<'d, T> |
| 23 | +where |
| 24 | + T: BorrowMut<UartDriver<'d>>, |
| 25 | +{ |
| 26 | + pub fn new(serial: T) -> Result<Self, EspError> { |
| 27 | + let netif = EspNetif::new(NetifStack::Ppp)?; |
| 28 | + let mut base = esp_netif_driver_base_t { |
| 29 | + netif: netif.handle(), |
| 30 | + post_attach: Some(Self::post_attach), |
| 31 | + }; |
| 32 | + let base_ptr: *mut c_void = &mut base as *mut _ as *mut c_void; |
| 33 | + esp!(unsafe { esp_netif_attach(netif.handle(), base_ptr) })?; |
| 34 | + Ok(Self { |
| 35 | + serial, |
| 36 | + netif, |
| 37 | + base, |
| 38 | + _d: PhantomData, |
| 39 | + }) |
| 40 | + } |
| 41 | + |
| 42 | + unsafe extern "C" fn post_attach(netif: *mut esp_netif_obj, args: *mut c_void) -> i32 { |
| 43 | + let driver= unsafe{std::ptr::slice_from_raw_parts_mut(args, size_of::<ppp_netif_driver())} |
| 44 | + let ifconfig = esp_netif_driver_ifconfig_t{handle} |
| 45 | + } |
| 46 | +} |
| 47 | + |
| 48 | +pub struct EspModem<'d, T> |
| 49 | +where |
| 50 | + T: BorrowMut<UartDriver<'d>>, |
| 51 | +{ |
| 52 | + serial: T, |
| 53 | + |
| 54 | + _d: PhantomData<&'d ()>, |
| 55 | +} |
| 56 | + |
| 57 | +impl<'d, T> EspModem<'d, T> |
| 58 | +where |
| 59 | + T: BorrowMut<UartDriver<'d>>, |
| 60 | +{ |
| 61 | + pub fn new(serial: T) -> Self { |
| 62 | + Self { |
| 63 | + serial, |
| 64 | + _d: PhantomData, |
| 65 | + } |
| 66 | + } |
| 67 | + |
| 68 | + pub fn send_cmd<CMD: AtatCmd>(&mut self, cmd: &CMD) -> Result<CMD::Response, atat::Error> { |
| 69 | + let mut buff = [0u8; 64]; |
| 70 | + // flush the channel |
| 71 | + // self.serial |
| 72 | + // .borrow_mut() |
| 73 | + // .clear_rx() |
| 74 | + // .map_err(|_err| atat::Error::Write)?; |
| 75 | + |
| 76 | + // write the command to the uart |
| 77 | + let len = cmd.write(&mut buff); |
| 78 | + log::info!("about to write {:?}", &buff[..len]); |
| 79 | + self.serial |
| 80 | + .borrow_mut() |
| 81 | + .write(&buff[..len]) |
| 82 | + .map_err(|_err| atat::Error::Write)?; |
| 83 | + |
| 84 | + // now read the uart to get the response |
| 85 | + |
| 86 | + let len = self |
| 87 | + .serial |
| 88 | + .borrow_mut() |
| 89 | + .read(&mut buff, TickType::new_millis(1000).ticks()) |
| 90 | + .map_err(|_err| atat::Error::Read)?; |
| 91 | + log::info!("got response {:?}", &buff[..len]); |
| 92 | + cmd.parse(Ok(&buff[..len])) |
| 93 | + } |
| 94 | + |
| 95 | + pub fn setup_data_mode(&mut self) -> Result<(), EspError> { |
| 96 | + self.reset()?; |
| 97 | + //disable echo |
| 98 | + self.set_echo(false)?; |
| 99 | + |
| 100 | + // check pdp network reg |
| 101 | + self.read_gprs_registration_status()?; |
| 102 | + |
| 103 | + //configure apn |
| 104 | + self.set_pdp_context()?; |
| 105 | + |
| 106 | + // start ppp |
| 107 | + self.set_data_mode()?; |
| 108 | + |
| 109 | + // now in ppp mode. |
| 110 | + // self.netif. |
| 111 | + |
| 112 | + Ok(()) |
| 113 | + } |
| 114 | + |
| 115 | + fn get_signal_quality(&mut self) -> Result<(), EspError> { |
| 116 | + let mut buff = [0u8; 64]; |
| 117 | + let cmd = CommandBuilder::create_execute(&mut buff, true) |
| 118 | + .named("+CSQ") |
| 119 | + .finish() |
| 120 | + .unwrap(); |
| 121 | + self.serial.borrow_mut().write(cmd)?; |
| 122 | + let len = self |
| 123 | + .serial |
| 124 | + .borrow_mut() |
| 125 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 126 | + log::info!("got response {:?}", &buff[..len]); |
| 127 | + |
| 128 | + // \r\n+CSQ: 19,99\r\n\r\nOK\r\n |
| 129 | + let (rssi, ber) = CommandParser::parse(&buff[..len]) |
| 130 | + .expect_identifier(b"\r\n+CSQ: ") |
| 131 | + .expect_int_parameter() |
| 132 | + .expect_int_parameter() |
| 133 | + .expect_identifier(b"\r\n\r\nOK\r\n") |
| 134 | + .finish() |
| 135 | + .unwrap(); |
| 136 | + log::info!("Signal Quality: rssi: {} ber: {}", rssi, ber); |
| 137 | + Ok(()) |
| 138 | + } |
| 139 | + |
| 140 | + fn reset(&mut self) -> Result<(), EspError> { |
| 141 | + let mut buff = [0u8; 64]; |
| 142 | + let cmd = CommandBuilder::create_execute(&mut buff, false) |
| 143 | + .named("ATZ0") |
| 144 | + .finish() |
| 145 | + .unwrap(); |
| 146 | + self.serial.borrow_mut().write(cmd)?; |
| 147 | + let len = self |
| 148 | + .serial |
| 149 | + .borrow_mut() |
| 150 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 151 | + log::info!("got response {:?}", &buff[..len]); |
| 152 | + CommandParser::parse(&buff[..len]) |
| 153 | + .expect_identifier(b"ATZ0\r") |
| 154 | + .expect_identifier(b"\r\nOK\r\n") |
| 155 | + .finish() |
| 156 | + .unwrap(); |
| 157 | + Ok(()) |
| 158 | + } |
| 159 | + |
| 160 | + fn set_echo(&mut self, echo: bool) -> Result<(), EspError> { |
| 161 | + let mut buff = [0u8; 64]; |
| 162 | + let cmd = CommandBuilder::create_execute(&mut buff, false) |
| 163 | + .named(format!("ATE{}", i32::from(echo))) |
| 164 | + .finish() |
| 165 | + .unwrap(); |
| 166 | + self.serial.borrow_mut().write(cmd)?; |
| 167 | + let len = self |
| 168 | + .serial |
| 169 | + .borrow_mut() |
| 170 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 171 | + log::info!("got response {:?}", &buff[..len]); |
| 172 | + |
| 173 | + CommandParser::parse(&buff[..len]) |
| 174 | + .expect_identifier(b"ATE0\r") |
| 175 | + .expect_identifier(b"\r\nOK\r\n") |
| 176 | + .finish() |
| 177 | + .unwrap(); |
| 178 | + Ok(()) |
| 179 | + } |
| 180 | + |
| 181 | + fn read_gprs_registration_status(&mut self) -> Result<(), EspError> { |
| 182 | + let mut buff = [0u8; 64]; |
| 183 | + let cmd = CommandBuilder::create_query(&mut buff, true) |
| 184 | + .named("+CGREG") |
| 185 | + .finish() |
| 186 | + .unwrap(); |
| 187 | + self.serial.borrow_mut().write(cmd)?; |
| 188 | + let len = self |
| 189 | + .serial |
| 190 | + .borrow_mut() |
| 191 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 192 | + log::info!("got response {:?}", &buff[..len]); |
| 193 | + |
| 194 | + let (n, stat, lac, ci) = CommandParser::parse(&buff[..len]) |
| 195 | + .expect_identifier(b"\r\n+CGREG: ") |
| 196 | + .expect_int_parameter() |
| 197 | + .expect_int_parameter() |
| 198 | + .expect_optional_int_parameter() |
| 199 | + .expect_optional_int_parameter() |
| 200 | + .expect_identifier(b"\r\n\r\nOK\r\n") |
| 201 | + .finish() |
| 202 | + .unwrap(); |
| 203 | + log::info!( |
| 204 | + "CGREG: n: {}stat: {}, lac: {:?}, ci: {:?} ", |
| 205 | + n, |
| 206 | + stat, |
| 207 | + lac, |
| 208 | + ci |
| 209 | + ); |
| 210 | + Ok(()) |
| 211 | + } |
| 212 | + |
| 213 | + fn set_pdp_context(&mut self) -> Result<(), EspError> { |
| 214 | + let mut buff = [0u8; 64]; |
| 215 | + let cmd = CommandBuilder::create_set(&mut buff, true) |
| 216 | + .named("+CGDCONT") |
| 217 | + .with_int_parameter(1) // context id |
| 218 | + .with_string_parameter("IP") // pdp type |
| 219 | + .with_string_parameter("internet") |
| 220 | + .finish() |
| 221 | + .unwrap(); |
| 222 | + self.serial.borrow_mut().write(cmd)?; |
| 223 | + let len = self |
| 224 | + .serial |
| 225 | + .borrow_mut() |
| 226 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 227 | + log::info!("got response {:?}", &buff[..len]); |
| 228 | + |
| 229 | + CommandParser::parse(&buff[..len]) |
| 230 | + .expect_identifier(b"\r\nOK\r\n") |
| 231 | + .finish() |
| 232 | + .unwrap(); |
| 233 | + |
| 234 | + Ok(()) |
| 235 | + } |
| 236 | + |
| 237 | + fn set_data_mode(&mut self) -> Result<(), EspError> { |
| 238 | + let mut buff = [0u8; 64]; |
| 239 | + let cmd = CommandBuilder::create_execute(&mut buff, false) |
| 240 | + .named("ATD*99#") |
| 241 | + .finish() |
| 242 | + .unwrap(); |
| 243 | + self.serial.borrow_mut().write(cmd)?; |
| 244 | + let len = self |
| 245 | + .serial |
| 246 | + .borrow_mut() |
| 247 | + .read(&mut buff, TickType::new_millis(1000).ticks())?; |
| 248 | + log::info!("got response {:?}", &buff[..len]); |
| 249 | + |
| 250 | + let (connect_parm,) = CommandParser::parse(&buff[..len]) |
| 251 | + .expect_identifier(b"\r\nCONNECT ") |
| 252 | + .expect_optional_raw_string() |
| 253 | + .expect_identifier(b"\r\n") |
| 254 | + .finish() |
| 255 | + .unwrap(); |
| 256 | + log::info!("connect {:?}", connect_parm); |
| 257 | + Ok(()) |
| 258 | + } |
| 259 | +} |
0 commit comments