tuneutils 0.1.1

Utilities for interfacing with, diagnosing, and tuning cars
Documentation
use std::sync::atomic::{AtomicBool, Ordering};
use std::thread;
use std::time;
use std::cell::RefCell;
use std::rc::Rc;
use std::sync::{Arc, Mutex};

use crate::{
	protocols::uds::UdsInterface,
	definition::{self, Pid},
	numvariant::NumVariant,
	error::Result,
};

extern crate eval;

pub struct Entry {
	pub data: RefCell<Vec<NumVariant>>,
	pub pid_id: u32,
}

pub struct Log {
	pub entries: Vec<Entry>,
	pub platform: Rc<definition::Main>,

	callbacks: Vec<Box<RefCell<FnMut(&Entry, NumVariant)>>>,
}


impl Log {
	pub fn new(platform: Rc<definition::Main>) -> Log {
		Log {
			entries: Vec::new(),
			platform,
			callbacks: Vec::new(),
		}
	}

	/// Adds a new entry and returns the index
	pub fn add_entry(&mut self, pid: &Pid) -> Result<usize> {
		let index = self.entries.len();
		// let expr = eval::Expr::new(pid.formula.clone()).compile()?;
		self.entries.push(Entry {
			data: RefCell::new(Vec::new()),
			pid_id: pid.id,
		});
		Ok(index)
	}

	/// Adds data to an entry
	pub fn add_data(&self, pid_id: u32, data: NumVariant) {
		//println!("{}: {:?}", entry.pid.name, f64::from(data));
		if let Some(entry) = self.entries.iter().find(|ref x| x.pid_id == pid_id) {
			entry.data.borrow_mut().push(data);

			for cb in &self.callbacks {
				let mut closure = cb.borrow_mut();
				(&mut *closure)(entry, data);
			}
		}
		//entry.data.borrow_mut().push(data);
		
	}

	pub fn register<F: FnMut(&Entry, NumVariant) + 'static>(&mut self, callback: F) {
		self.callbacks.push(Box::new(RefCell::new(callback)));
	}
}

pub trait Logger {
	fn run(&mut self, log: &mut Log) -> Result<()>;

	fn add_entry(&mut self, pid: &Pid) -> Result<usize>;

	fn stop(&mut self);
}

pub struct LoggerEntry {
	pub pid_id: u32,
	pub code: u16,
	pub expr: eval::Expr,
}

pub struct UdsLogger {
	interface: Rc<UdsInterface>,
	running: AtomicBool,
	entries: Vec<LoggerEntry>
}

impl UdsLogger {
	pub fn new(interface: Rc<UdsInterface>) -> UdsLogger {
		UdsLogger {
			interface,
			running: AtomicBool::new(false),
			entries: Vec::new(),
		}
	}
}

impl Logger for UdsLogger {
	/// Adds a new entry and returns the index
	fn add_entry(&mut self, pid: &Pid) -> Result<usize> {
		let index = self.entries.len();
		let expr = eval::Expr::new(pid.formula.clone()).compile()?;
		self.entries.push(LoggerEntry {
			expr,
			pid_id: pid.id,
			code: pid.code,
		});
		Ok(index)
	}

	fn run(&mut self, log: &mut Log) -> Result<()> {
		assert_eq!(self.running.load(Ordering::SeqCst), false);
		*self.running.get_mut() = true;

		// Start logging
		while self.running.load(Ordering::Relaxed) {
			for entry in &self.entries {
				// Send UDS request
				let response = self.interface.read_data_by_identifier(entry.code)?;//(((entry.pid.code & 0xFF00) >> 8) as u8, &[(entry.pid.code & 0xFF) as u8])?;

				let mut context = eval::Context::new();
				if response.len() >= 3 {
					context.insert("c".to_string(), eval::to_value(response[2]));
				}
				if response.len() >= 2 {
					context.insert("b".to_string(), eval::to_value(response[1]));
				}
				if response.len() >= 1 {
					context.insert("a".to_string(), eval::to_value(response[0]));
				}

				// Evaluate the expression
				let val = eval::ExecOptions::new(&entry.expr).contexts(&[context]).exec()?;
				/*let num = (|| {
					if val.is_u64() {
						return NumVariant::U64(val.as_u64().unwrap());
					}
					if val.is_i64() {
						return NumVariant::I64(val.as_i64().unwrap());
					}
					if val.is_f64() {
						return NumVariant::F64(val.as_f64().unwrap());
					}
					// This shouldn't ever happen
					return NumVariant::I64(0);
				})();*/
				// TODO: Use PID datatype for conversion
				let num = NumVariant::F64(val.as_f64().unwrap());

				// Add the data to the log
				log.add_data(entry.pid_id, num);
			}
			thread::sleep(time::Duration::from_millis(1000));
		}

		*self.running.get_mut() = false;

		Ok(())
	}

	fn stop(&mut self) {
		*self.running.get_mut() = false;
	}
}