This commit is contained in:
Nicholas Orlowsky 2025-03-18 21:15:33 -04:00
parent 6effd4f1a8
commit e941cf8bc8
5 changed files with 22 additions and 100 deletions

View file

@ -12,4 +12,3 @@ ftdi = "0.1.3"
log = "0.4.8"
thiserror = "1.0.15"
serialport="=4.6.1"
anyhow = "1.0.97"

View file

@ -1,116 +1,27 @@
use log::{debug, info, trace};
use std::{
collections::VecDeque,
io::{Read, Write},
thread, time,
};
use std::time::Duration;
use super::{Error, Obd2BaseDevice, Obd2Reader, Result};
trait SerialDevice {
fn write_all(&mut self, data: &[u8]) -> Result<()>;
fn read(&mut self, data: &mut [u8]) -> Result<usize>;
fn set_baud_rate(&mut self, baud_rate: u32) -> Result<()>;
fn purge_buffers(&mut self) -> Result<()>;
}
pub struct SerialPort {
device: Box<dyn serialport::SerialPort>
}
impl SerialPort {
pub fn new(path: &str) -> Result<Self> {
let port = serialport::new(path, 38_400)
.timeout(Duration::from_millis(10))
.parity(serialport::Parity::None)
.data_bits(serialport::DataBits::Eight)
.stop_bits(serialport::StopBits::One)
.path(path)
.open()?;
let device = SerialPort {
device: port
};
Ok(device)
}
}
impl SerialDevice for SerialPort {
fn write_all(&mut self, data: &[u8]) -> Result<()> {
Ok(self.device.write_all(data)?)
}
fn read(&mut self, data: &mut [u8]) -> Result<usize> {
Ok(self.device.read(data)?)
}
fn set_baud_rate(&mut self, baud_rate: u32) -> Result<()> {
Ok(self.device.set_baud_rate(baud_rate)?)
}
fn purge_buffers(&mut self) -> Result<()> {
Ok(self.device.clear(serialport::ClearBuffer::All)?)
}
}
pub struct FTDIDevice {
device: ftdi::Device
}
impl FTDIDevice {
pub fn new() -> Result<Self> {
let mut ftdi_device = ftdi::find_by_vid_pid(0x0404, 0x6001)
.interface(ftdi::Interface::A)
.open()?;
ftdi_device.set_baud_rate(38400)?;
ftdi_device.configure(ftdi::Bits::Eight, ftdi::StopBits::One, ftdi::Parity::None)?;
ftdi_device.usb_reset()?;
let device = FTDIDevice {
device: ftdi_device
};
Ok(device)
}
}
impl SerialDevice for FTDIDevice {
fn write_all(&mut self, data: &[u8]) -> Result<()> {
Ok(self.device.write_all(data)?)
}
fn read(&mut self, data: &mut [u8]) -> Result<usize> {
Ok(self.device.read(data)?)
}
fn set_baud_rate(&mut self, baud_rate: u32) -> Result<()> {
Ok(self.device.set_baud_rate(baud_rate)?)
}
fn purge_buffers(&mut self) -> Result<()> {
Ok(self.device.usb_purge_buffers()?)
}
}
use super::{Error, Obd2BaseDevice, Obd2Reader, Result, serial_comm::SerialComm};
/// An ELM327 OBD-II adapter
///
/// It communicates with the computer over UART using an FTDI FT232R USB-to-UART converter.
/// It communicates with the computer or UART using an FTDI FT232R USB-to-UART converter.
/// Commands to the device itself are indicated by sending "AT" followed by the command, while
/// plain strings of hex data indicate OBD-II requests to be sent to the vehicle. The responses of
/// the vehicle are echoed back as hex characters. Capitalization and spaces are always ignored.
///
/// [Datasheet for v1.4b](https://github.com/rsammelson/obd2/blob/master/docs/ELM327DSH.pdf), and
/// the [source](https://www.elmelectronics.com/products/dsheets/).
pub struct Elm327<T: SerialDevice> {
pub struct Elm327<T: SerialComm> {
device: T,
buffer: VecDeque<u8>,
baud_rate: u32,
}
impl<T: SerialDevice> Obd2BaseDevice for Elm327<T> {
impl<T: SerialComm> Obd2BaseDevice for Elm327<T> {
fn reset(&mut self) -> Result<()> {
self.flush_buffers()?;
self.reset_ic()?;
@ -130,7 +41,7 @@ impl<T: SerialDevice> Obd2BaseDevice for Elm327<T> {
}
}
impl<T: SerialDevice> Obd2Reader for Elm327<T> {
impl<T: SerialComm> Obd2Reader for Elm327<T> {
fn get_line(&mut self) -> Result<Option<Vec<u8>>> {
self.get_until(b'\n', false)
}
@ -146,7 +57,9 @@ impl<T: SerialDevice> Obd2Reader for Elm327<T> {
}
}
impl<T: SerialDevice> Elm327<T> {
impl<T: SerialComm> Elm327<T> {
/// Creates a new Elm327 adapter with the given
/// unserlying Serial Communication device
pub fn new(serial_device: T) -> Result<Self> {
let mut device = Elm327 {
device: serial_device,

View file

@ -1,7 +1,10 @@
//! Lower level OBD-II interfacing structures
mod elm327;
pub use elm327::{Elm327, SerialPort, FTDIDevice};
pub use elm327::Elm327;
mod serial_comm;
pub use serial_comm::{SerialPort, FTDIDevice};
type Result<T> = std::result::Result<T, Error>;
@ -54,6 +57,7 @@ pub enum Error {
#[error("FTDI error: `{0:?}`")]
Ftdi(ftdi::Error),
/// An error with the underlying [serialport device](serialport::SerialPort)
#[error("Serialport error: `{0:?}`")]
Serialport(serialport::Error),

View file

@ -1,3 +1,6 @@
//! Error types for OBD-II related errors
/// Result type defaulted with this library's error type
pub type Result<T> = std::result::Result<T, Error>;
/// An error with OBD-II communication
@ -16,6 +19,7 @@ pub enum Error {
Other(String),
}
/// An error with the ELM327 device
#[derive(Debug)]
pub struct DeviceError(pub crate::device::Error);
@ -27,12 +31,12 @@ impl From<super::device::Error> for Error {
impl From<std::num::ParseIntError> for Error {
fn from(e: std::num::ParseIntError) -> Self {
Error::Other(format!("invalid data recieved: {:?}", e))
Error::Other(format!("invalid data received: {:?}", e))
}
}
impl From<std::string::FromUtf8Error> for Error {
fn from(e: std::string::FromUtf8Error) -> Self {
Error::Other(format!("invalid string recieved: {:?}", e))
Error::Other(format!("invalid string received: {:?}", e))
}
}

View file

@ -40,7 +40,8 @@ impl<T: Obd2BaseDevice> Obd2Device for Obd2<T> {
}
impl<T: Obd2BaseDevice> Obd2<T> {
pub fn new(dev: T) -> ::anyhow::Result<Self> {
/// Creates a new instance of an Obd device
pub fn new(dev: T) -> Result<Self> {
let device = Obd2 {
device: dev
};
@ -48,6 +49,7 @@ impl<T: Obd2BaseDevice> Obd2<T> {
Ok(device)
}
/// Resets the device
pub fn reset(&mut self) -> Result<()> {
Ok(self.device.reset()?)
}