Use traits for basic reader
This commit is contained in:
parent
4d08a680d1
commit
cd82a02efb
|
@ -2,7 +2,7 @@ mod obd2;
|
||||||
|
|
||||||
fn main() {
|
fn main() {
|
||||||
env_logger::init();
|
env_logger::init();
|
||||||
let mut device = obd2::Obd2::default();
|
let mut device: obd2::Obd2<obd2::Elm327> = obd2::Obd2::default();
|
||||||
|
|
||||||
println!("VIN: {:?}", device.get_vin());
|
println!("VIN: {:?}", device.get_vin());
|
||||||
println!("DTC Info: {:#?}", device.get_dtc_info());
|
println!("DTC Info: {:#?}", device.get_dtc_info());
|
||||||
|
|
|
@ -5,20 +5,80 @@ use std::{
|
||||||
thread, time,
|
thread, time,
|
||||||
};
|
};
|
||||||
|
|
||||||
type Result<T> = std::result::Result<T, Error>;
|
use super::{Error, Obd2BaseDevice, Obd2Reader, Result};
|
||||||
|
|
||||||
pub struct Obd2Basic {
|
pub struct Elm327 {
|
||||||
device: ftdi::Device,
|
device: ftdi::Device,
|
||||||
buffer: VecDeque<u8>,
|
buffer: VecDeque<u8>,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl Default for Obd2Basic {
|
impl Default for Elm327 {
|
||||||
fn default() -> Self {
|
fn default() -> Self {
|
||||||
Obd2Basic::new().unwrap()
|
Elm327::new().unwrap()
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
impl Obd2Basic {
|
impl Obd2BaseDevice for Elm327 {
|
||||||
|
fn reset(&mut self) -> Result<()> {
|
||||||
|
self.flush_buffers()?;
|
||||||
|
self.reset_ic()?;
|
||||||
|
thread::sleep(time::Duration::from_millis(500));
|
||||||
|
self.reset_protocol()?;
|
||||||
|
Ok(())
|
||||||
|
}
|
||||||
|
|
||||||
|
fn flush(&mut self) -> Result<()> {
|
||||||
|
thread::sleep(time::Duration::from_millis(500));
|
||||||
|
self.read_into_queue()?;
|
||||||
|
self.buffer.clear();
|
||||||
|
thread::sleep(time::Duration::from_millis(500));
|
||||||
|
Ok(())
|
||||||
|
}
|
||||||
|
|
||||||
|
fn send_serial_cmd(&mut self, data: &str) -> Result<()> {
|
||||||
|
self.device.write_all(data.as_bytes())?;
|
||||||
|
self.device.write_all(b"\r\n")?;
|
||||||
|
let line = self.get_line()?;
|
||||||
|
if line.as_ref().is_some_and(|v| v == data.as_bytes()) {
|
||||||
|
Ok(())
|
||||||
|
} else {
|
||||||
|
Err(Error::Communication(format!(
|
||||||
|
"send_serial_cmd: got {:?} instead of echoed command ({})",
|
||||||
|
line, data
|
||||||
|
)))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl Obd2Reader for Elm327 {
|
||||||
|
fn get_line(&mut self) -> Result<Option<Vec<u8>>> {
|
||||||
|
let result = self.get_until(b'\n')?;
|
||||||
|
let Some(mut line) = result else {
|
||||||
|
return Ok(result);
|
||||||
|
};
|
||||||
|
if line.pop() == Some(b'\n') {
|
||||||
|
Ok(Some(line))
|
||||||
|
} else {
|
||||||
|
Err(Error::Communication("get_line no line ending".to_owned()))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn get_until_prompt(&mut self) -> Result<Option<Vec<u8>>> {
|
||||||
|
let result = self.get_until(b'>')?;
|
||||||
|
let Some(mut line) = result else {
|
||||||
|
return Ok(result);
|
||||||
|
};
|
||||||
|
if line.pop() == Some(b'>') {
|
||||||
|
Ok(Some(line))
|
||||||
|
} else {
|
||||||
|
Err(Error::Communication(
|
||||||
|
"get_until_prompt no ending".to_owned(),
|
||||||
|
))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl Elm327 {
|
||||||
fn new() -> Result<Self> {
|
fn new() -> Result<Self> {
|
||||||
let mut ftdi_device = ftdi::find_by_vid_pid(0x0403, 0x6001)
|
let mut ftdi_device = ftdi::find_by_vid_pid(0x0403, 0x6001)
|
||||||
.interface(ftdi::Interface::A)
|
.interface(ftdi::Interface::A)
|
||||||
|
@ -30,7 +90,7 @@ impl Obd2Basic {
|
||||||
|
|
||||||
ftdi_device.usb_reset()?;
|
ftdi_device.usb_reset()?;
|
||||||
|
|
||||||
let mut device = Obd2Basic {
|
let mut device = Elm327 {
|
||||||
device: ftdi_device,
|
device: ftdi_device,
|
||||||
buffer: VecDeque::new(),
|
buffer: VecDeque::new(),
|
||||||
};
|
};
|
||||||
|
@ -52,20 +112,6 @@ impl Obd2Basic {
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn reset(&mut self) -> Result<()> {
|
|
||||||
self.flush_buffers()?;
|
|
||||||
self.reset_ic()?;
|
|
||||||
thread::sleep(time::Duration::from_millis(500));
|
|
||||||
self.reset_protocol()?;
|
|
||||||
Ok(())
|
|
||||||
}
|
|
||||||
|
|
||||||
pub fn cmd(&mut self, cmd: &str) -> Result<Option<String>> {
|
|
||||||
self.send_serial_cmd(cmd)?;
|
|
||||||
self.get_until_prompt()
|
|
||||||
.map(|o| o.and_then(|resp| String::from_utf8(resp).ok()))
|
|
||||||
}
|
|
||||||
|
|
||||||
fn reset_ic(&mut self) -> Result<()> {
|
fn reset_ic(&mut self) -> Result<()> {
|
||||||
info!("Performing IC reset");
|
info!("Performing IC reset");
|
||||||
self.send_serial_cmd("atz")?;
|
self.send_serial_cmd("atz")?;
|
||||||
|
@ -86,32 +132,6 @@ impl Obd2Basic {
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn get_line(&mut self) -> Result<Option<Vec<u8>>> {
|
|
||||||
let result = self.get_until(b'\n')?;
|
|
||||||
let Some(mut line) = result else {
|
|
||||||
return Ok(result);
|
|
||||||
};
|
|
||||||
if line.pop() == Some(b'\n') {
|
|
||||||
Ok(Some(line))
|
|
||||||
} else {
|
|
||||||
Err(Error::Communication("get_line no line ending".to_owned()))
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub fn get_until_prompt(&mut self) -> Result<Option<Vec<u8>>> {
|
|
||||||
let result = self.get_until(b'>')?;
|
|
||||||
let Some(mut line) = result else {
|
|
||||||
return Ok(result);
|
|
||||||
};
|
|
||||||
if line.pop() == Some(b'>') {
|
|
||||||
Ok(Some(line))
|
|
||||||
} else {
|
|
||||||
Err(Error::Communication(
|
|
||||||
"get_until_prompt no ending".to_owned(),
|
|
||||||
))
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn get_until(&mut self, end_byte: u8) -> Result<Option<Vec<u8>>> {
|
fn get_until(&mut self, end_byte: u8) -> Result<Option<Vec<u8>>> {
|
||||||
const TIMEOUT: time::Duration = time::Duration::from_secs(5);
|
const TIMEOUT: time::Duration = time::Duration::from_secs(5);
|
||||||
|
|
||||||
|
@ -166,33 +186,11 @@ impl Obd2Basic {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn flush(&mut self) -> Result<()> {
|
|
||||||
thread::sleep(time::Duration::from_millis(500));
|
|
||||||
self.read_into_queue()?;
|
|
||||||
self.buffer.clear();
|
|
||||||
thread::sleep(time::Duration::from_millis(500));
|
|
||||||
Ok(())
|
|
||||||
}
|
|
||||||
|
|
||||||
fn flush_buffers(&mut self) -> Result<()> {
|
fn flush_buffers(&mut self) -> Result<()> {
|
||||||
self.device.usb_purge_buffers()?;
|
self.device.usb_purge_buffers()?;
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn send_serial_cmd(&mut self, data: &str) -> Result<()> {
|
|
||||||
self.device.write_all(data.as_bytes())?;
|
|
||||||
self.device.write_all(b"\r\n")?;
|
|
||||||
let line = self.get_line()?;
|
|
||||||
if line.as_ref().is_some_and(|v| v == data.as_bytes()) {
|
|
||||||
Ok(())
|
|
||||||
} else {
|
|
||||||
Err(Error::Communication(format!(
|
|
||||||
"send_serial_cmd: got {:?} instead of echoed command ({})",
|
|
||||||
line, data
|
|
||||||
)))
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn send_serial_str(&mut self, data: &str) -> Result<()> {
|
fn send_serial_str(&mut self, data: &str) -> Result<()> {
|
||||||
self.device.write_all(data.as_bytes())?;
|
self.device.write_all(data.as_bytes())?;
|
||||||
Ok(())
|
Ok(())
|
||||||
|
@ -216,25 +214,3 @@ impl Obd2Basic {
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#[derive(thiserror::Error, Debug)]
|
|
||||||
pub enum Error {
|
|
||||||
#[error("FTDI error: `{0:?}`")]
|
|
||||||
Ftdi(ftdi::Error),
|
|
||||||
#[error("IO error: `{0:?}`")]
|
|
||||||
IO(std::io::Error),
|
|
||||||
#[error("Communication error: `{0}`")]
|
|
||||||
Communication(String),
|
|
||||||
}
|
|
||||||
|
|
||||||
impl From<ftdi::Error> for Error {
|
|
||||||
fn from(e: ftdi::Error) -> Self {
|
|
||||||
Error::Ftdi(e)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
impl From<std::io::Error> for Error {
|
|
||||||
fn from(e: std::io::Error) -> Self {
|
|
||||||
Error::IO(e)
|
|
||||||
}
|
|
||||||
}
|
|
42
src/obd2/device/mod.rs
Normal file
42
src/obd2/device/mod.rs
Normal file
|
@ -0,0 +1,42 @@
|
||||||
|
mod elm327;
|
||||||
|
pub use elm327::Elm327;
|
||||||
|
|
||||||
|
type Result<T> = std::result::Result<T, Error>;
|
||||||
|
|
||||||
|
pub trait Obd2BaseDevice: Obd2Reader {
|
||||||
|
fn reset(&mut self) -> Result<()>;
|
||||||
|
fn flush(&mut self) -> Result<()>;
|
||||||
|
fn send_serial_cmd(&mut self, data: &str) -> Result<()>;
|
||||||
|
fn cmd(&mut self, cmd: &str) -> Result<Option<String>> {
|
||||||
|
self.send_serial_cmd(cmd)?;
|
||||||
|
self.get_until_prompt()
|
||||||
|
.map(|o| o.and_then(|resp| String::from_utf8(resp).ok()))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub trait Obd2Reader {
|
||||||
|
fn get_line(&mut self) -> Result<Option<Vec<u8>>>;
|
||||||
|
fn get_until_prompt(&mut self) -> Result<Option<Vec<u8>>>;
|
||||||
|
}
|
||||||
|
|
||||||
|
#[derive(thiserror::Error, Debug)]
|
||||||
|
pub enum Error {
|
||||||
|
#[error("FTDI error: `{0:?}`")]
|
||||||
|
Ftdi(ftdi::Error),
|
||||||
|
#[error("IO error: `{0:?}`")]
|
||||||
|
IO(std::io::Error),
|
||||||
|
#[error("Communication error: `{0}`")]
|
||||||
|
Communication(String),
|
||||||
|
}
|
||||||
|
|
||||||
|
impl From<ftdi::Error> for Error {
|
||||||
|
fn from(e: ftdi::Error) -> Self {
|
||||||
|
Error::Ftdi(e)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl From<std::io::Error> for Error {
|
||||||
|
fn from(e: std::io::Error) -> Self {
|
||||||
|
Error::IO(e)
|
||||||
|
}
|
||||||
|
}
|
|
@ -1,17 +1,19 @@
|
||||||
|
mod device;
|
||||||
|
pub use device::Elm327;
|
||||||
|
use device::Obd2BaseDevice;
|
||||||
|
|
||||||
use core::fmt;
|
use core::fmt;
|
||||||
|
|
||||||
use log::{debug, trace};
|
use log::{debug, trace};
|
||||||
|
|
||||||
mod device;
|
|
||||||
|
|
||||||
type Result<T> = std::result::Result<T, Error>;
|
type Result<T> = std::result::Result<T, Error>;
|
||||||
|
|
||||||
#[derive(Default)]
|
#[derive(Default)]
|
||||||
pub struct Obd2 {
|
pub struct Obd2<T: Obd2BaseDevice> {
|
||||||
device: device::Obd2Basic,
|
device: T,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl Obd2 {
|
impl<T: Obd2BaseDevice> Obd2<T> {
|
||||||
pub fn obd_command(&mut self, mode: u8, pid: u8) -> Result<Vec<Vec<u8>>> {
|
pub fn obd_command(&mut self, mode: u8, pid: u8) -> Result<Vec<Vec<u8>>> {
|
||||||
let result = self.command(&format!("{:02x}{:02x}", mode, pid))?;
|
let result = self.command(&format!("{:02x}{:02x}", mode, pid))?;
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue