From b9b5349b4b78a5d59be4a7e4a11f712e2f6a8256 Mon Sep 17 00:00:00 2001 From: Diego Barrios Romero Date: Sun, 11 Nov 2018 11:44:24 +0100 Subject: Move setting the thresholds to tier2 features --- src/devices/features/tier1.rs | 57 ------------------------------------------- src/devices/features/tier2.rs | 57 +++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 57 insertions(+), 57 deletions(-) (limited to 'src') diff --git a/src/devices/features/tier1.rs b/src/devices/features/tier1.rs index 9f72b77..4bbf7d1 100644 --- a/src/devices/features/tier1.rs +++ b/src/devices/features/tier1.rs @@ -23,61 +23,4 @@ where self.config = config; Ok(()) } - - /// Set comparator lower threshold - pub fn set_low_threshold(&mut self, value: i16) -> Result<(), Error> { - let register_value = convert_threshold::(value)?; - self.iface.write_register(Register::LOW_TH, register_value) - } - - /// Set comparator upper threshold - pub fn set_high_threshold(&mut self, value: i16) -> Result<(), Error> { - let register_value = convert_threshold::(value)?; - self.iface.write_register(Register::HIGH_TH, register_value) - } -} - -fn convert_threshold(value: i16) -> Result> -where - IC: ic::Resolution -{ - if IC::BITS == ic::ResolutionBits::_12 { - if value < -2048 || value > 2047 { - return Err(Error::InvalidInputData); - } - Ok((value << 4) as u16) - } - else { - Ok(value as u16) - } } - -#[cfg(test)] -mod tests { - use super::*; - - fn assert_invalid_input_data(result: Result>) { - match result { - Err(Error::InvalidInputData) => (), - _ => panic!("InvalidInputData error was not returned.") - } - } - - #[test] - fn convert_12_bits() { - assert_invalid_input_data(convert_threshold::(2048)); - assert_invalid_input_data(convert_threshold::(-2049)); - - assert_eq!( 0, convert_threshold::(0).unwrap()); - assert_eq!(0x7FF0, convert_threshold::(2047).unwrap()); - assert_eq!(0x8000, convert_threshold::(-2048).unwrap()); - assert_eq!(0xFFF0, convert_threshold::(-1).unwrap()); - } - - #[test] - fn convert_16_bits() { - assert_eq!(0x7FFF, convert_threshold::(32767).unwrap()); - assert_eq!(0x8000, convert_threshold::(-32768).unwrap()); - } -} - diff --git a/src/devices/features/tier2.rs b/src/devices/features/tier2.rs index 43dce5c..2aa649f 100644 --- a/src/devices/features/tier2.rs +++ b/src/devices/features/tier2.rs @@ -10,6 +10,18 @@ where DI: interface::WriteData, IC: ic::Resolution + ic::Tier2Features { + /// Set comparator lower threshold + pub fn set_low_threshold(&mut self, value: i16) -> Result<(), Error> { + let register_value = convert_threshold::(value)?; + self.iface.write_register(Register::LOW_TH, register_value) + } + + /// Set comparator upper threshold + pub fn set_high_threshold(&mut self, value: i16) -> Result<(), Error> { + let register_value = convert_threshold::(value)?; + self.iface.write_register(Register::HIGH_TH, register_value) + } + /// Set comparator mode pub fn set_comparator_mode(&mut self, mode: ComparatorMode) -> Result<(), Error> { let config; @@ -46,3 +58,48 @@ where Ok(()) } } + + +fn convert_threshold(value: i16) -> Result> +where + IC: ic::Resolution +{ + if IC::BITS == ic::ResolutionBits::_12 { + if value < -2048 || value > 2047 { + return Err(Error::InvalidInputData); + } + Ok((value << 4) as u16) + } + else { + Ok(value as u16) + } +} + +#[cfg(test)] +mod tests { + use super::*; + + fn assert_invalid_input_data(result: Result>) { + match result { + Err(Error::InvalidInputData) => (), + _ => panic!("InvalidInputData error was not returned.") + } + } + + #[test] + fn convert_12_bits() { + assert_invalid_input_data(convert_threshold::(2048)); + assert_invalid_input_data(convert_threshold::(-2049)); + + assert_eq!( 0, convert_threshold::(0).unwrap()); + assert_eq!(0x7FF0, convert_threshold::(2047).unwrap()); + assert_eq!(0x8000, convert_threshold::(-2048).unwrap()); + assert_eq!(0xFFF0, convert_threshold::(-1).unwrap()); + } + + #[test] + fn convert_16_bits() { + assert_eq!(0x7FFF, convert_threshold::(32767).unwrap()); + assert_eq!(0x8000, convert_threshold::(-32768).unwrap()); + } +} -- cgit v1.2.3-54-g00ecf