e-bike-tracker
/
e-bike-tracker-device
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

use same interface in gps as in gsm modem

This commit is contained in:
Vladan Popovic 2022-07-20 12:33:11 +02:00
parent 63359cc4c0
commit 23ff182b65
1 changed files with 34 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

50
src/gps.rs
View File

@ -8,24 +8,22 @@ use std::{
}; };
use esp_idf_hal::prelude::*; use esp_idf_hal::prelude::*;
use esp_idf_hal::serial; use esp_idf_hal::serial::{self, Rx, Tx};
use esp_idf_hal::gpio::*;
use ublox::*; use ublox::*;
use crate::modem::Msg; use crate::modem::Msg;
use crate::serial::SerialIO; use crate::serial::SerialIO;
struct Device<UART: serial::Uart> { struct GpsModule<UART: serial::Uart> {
port: SerialIO<UART>, port: SerialIO<UART>,
parser: Parser<Vec<u8>>, parser: Parser<Vec<u8>>,
} }
impl<UART: serial::Uart> Device<UART> { impl<UART: serial::Uart> GpsModule<UART> {
pub fn new<T: Sync + Send>(port: serial::Serial<UART, Gpio12<T>, Gpio13<T>>) -> Device<UART> { pub fn new(tx: Tx<UART>, rx: Rx<UART>) -> Self {
let parser = Parser::default(); let parser = Parser::default();
let (tx, rx) = port.split(); GpsModule { port: SerialIO::new(tx, rx), parser }
Device { port: SerialIO::new(tx, rx), parser }
} }
pub fn write_all(&mut self, data: &[u8]) -> std::io::Result<()> { pub fn write_all(&mut self, data: &[u8]) -> std::io::Result<()> {
@ -39,6 +37,7 @@ impl<UART: serial::Uart> Device<UART> {
let mut local_buf = [0; 1024]; let mut local_buf = [0; 1024];
let nbytes = self.read_port(&mut local_buf)?; let nbytes = self.read_port(&mut local_buf)?;
if nbytes == 0 { if nbytes == 0 {
println!("no bytes to read :(");
break; break;
} }
// parser.consume adds the buffer to its internal buffer, and // parser.consume adds the buffer to its internal buffer, and
@ -52,7 +51,7 @@ impl<UART: serial::Uart> Device<UART> {
Ok(()) Ok(())
} }
pub fn wait_for_ack<T: UbxPacketMeta>(&mut self, timeout: Duration) -> std::io::Result<()> { pub fn wait_for_ack<T: UbxPacketMeta>(&mut self, timeout: Duration) -> std::io::Result<bool> {
let mut found_packet = false; let mut found_packet = false;
println!("LOOKING FOR ACK ..."); println!("LOOKING FOR ACK ...");
let start = Instant::now(); let start = Instant::now();
@ -64,9 +63,13 @@ impl<UART: serial::Uart> Device<UART> {
found_packet = true; found_packet = true;
} }
} }
else if let PacketRef::AckNak(nak) = packet {
println!("NAK PACKET: {} {}", nak.class(), nak.msg_id());
}
})?; })?;
} }
Ok(()) println!("exiting wait_for_ack");
Ok(found_packet)
} }
/// Reads the serial port, converting timeouts into "no data received" /// Reads the serial port, converting timeouts into "no data received"
@ -110,7 +113,8 @@ pub fn main<T: Sync + Send>(
serial_config, serial_config,
)?; )?;
let mut device = Device::new(serial); let (tx, rx) = serial.split();
let mut device = GpsModule::new(tx, rx);
// Configure the device to talk UBX // Configure the device to talk UBX
device device
@ -127,25 +131,30 @@ pub fn main<T: Sync + Send>(
reserved5: 0, reserved5: 0,
} }
.into_packet_bytes(), .into_packet_bytes(),
) )?;
.unwrap();
device.wait_for_ack::<CfgPrtUart>(Duration::from_millis(3000)).unwrap(); device.wait_for_ack::<CfgPrtUart>(Duration::from_millis(3000)).unwrap();
println!("CfgPrtUart acked!"); println!("CfgPrtUart acked!");
// Enable the NavPosVelTime packet // Set interval for the NavPosVelTime packet
println!("Sending set_rate_for::<NavPosVelTime> ...");
for i in 1..5 {
device device
.write_all( .write_all(
&CfgMsgAllPortsBuilder::set_rate_for::<NavPosVelTime>([0, 0, 1, 0, 0, 0]) &CfgMsgAllPortsBuilder::set_rate_for::<NavPosVelTime>([0, 1, 1, 0, 0, 0])
.into_packet_bytes(), .into_packet_bytes(),
) )
.unwrap(); .unwrap();
device.wait_for_ack::<CfgMsgAllPorts>(Duration::from_millis(3000)).unwrap(); println!("SENT set_rate_for::<NavPosVelTime>({}) !!!", i);
println!("CfgMsgAllPorts acked!"); if let Ok(true) = device.wait_for_ack::<CfgMsgSinglePort>(Duration::from_millis(3000)) {
println!("Setting rate for NavPosVelTime acked! Exiting loop ...");
break
}
}
// Send a packet request for the MonVer packet // Send a packet request for the MonVer packet
device //device
.write_all(&UbxPacketRequest::request_for::<MonVer>().into_packet_bytes()) // .write_all(&UbxPacketRequest::request_for::<MonVer>().into_packet_bytes())
.unwrap(); // .unwrap();
// Start reading data // Start reading data
println!("Opened u-blox device, waiting for solutions..."); println!("Opened u-blox device, waiting for solutions...");
@ -181,7 +190,8 @@ pub fn main<T: Sync + Send>(
_ => { _ => {
println!("{:?}", packet); println!("{:?}", packet);
} }
})? })?;
thread::sleep(Duration::from_millis(1000));
} }
println!("exiting GPS sender loop :)"); println!("exiting GPS sender loop :)");