Digi XBeeLib fixed for NonCopyable issue
Dependents: XBeeZB_Receive_Data
Fork of XBeeLib by
This lib fixes NonCopyable<T> issues of Digi XBeeLib. Also, lib has been reworked in order to make it RTOS-aware, overcoming several others issues due to stdio Mutex operations.
IO/IOSampleZB.cpp@0:fcaad0dfa051, 2015-05-08 (annotated)
- Committer:
- spastor
- Date:
- Fri May 08 11:50:56 2015 +0200
- Revision:
- 0:fcaad0dfa051
- Child:
- 3:8662ebe83570
Automatic upload
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
spastor | 0:fcaad0dfa051 | 1 | #include "XBeeLib.h" |
spastor | 0:fcaad0dfa051 | 2 | #include "IO/IOSampleZB.h" |
spastor | 0:fcaad0dfa051 | 3 | |
spastor | 0:fcaad0dfa051 | 4 | #define IO_SAMPLE_ZB_MIN_SIZE (2 + 1 + 2) |
spastor | 0:fcaad0dfa051 | 5 | |
spastor | 0:fcaad0dfa051 | 6 | using namespace XBeeLib; |
spastor | 0:fcaad0dfa051 | 7 | |
spastor | 0:fcaad0dfa051 | 8 | IOSampleZB::IOSampleZB(const uint8_t* const raw_data, size_t size) |
spastor | 0:fcaad0dfa051 | 9 | { |
spastor | 0:fcaad0dfa051 | 10 | assert(size >= IO_SAMPLE_ZB_MIN_SIZE); |
spastor | 0:fcaad0dfa051 | 11 | assert(size <= sizeof _sampled_data); |
spastor | 0:fcaad0dfa051 | 12 | |
spastor | 0:fcaad0dfa051 | 13 | _digital_mask = UINT16(raw_data[1], raw_data[2]); |
spastor | 0:fcaad0dfa051 | 14 | _analog_mask = raw_data[3]; |
spastor | 0:fcaad0dfa051 | 15 | _sampled_data_size = size - 4; |
spastor | 0:fcaad0dfa051 | 16 | memcpy(&_sampled_data[0], &raw_data[4], _sampled_data_size); |
spastor | 0:fcaad0dfa051 | 17 | } |
spastor | 0:fcaad0dfa051 | 18 | |
spastor | 0:fcaad0dfa051 | 19 | IOSampleZB::~IOSampleZB() |
spastor | 0:fcaad0dfa051 | 20 | { |
spastor | 0:fcaad0dfa051 | 21 | |
spastor | 0:fcaad0dfa051 | 22 | } |
spastor | 0:fcaad0dfa051 | 23 | |
spastor | 0:fcaad0dfa051 | 24 | RadioStatus IOSampleZB::get_dio(XBeeZB::IoLine line, DioVal* const dio_value) const |
spastor | 0:fcaad0dfa051 | 25 | { |
spastor | 0:fcaad0dfa051 | 26 | const uint16_t mask = 1 << line; |
spastor | 0:fcaad0dfa051 | 27 | if (mask & _digital_mask) { |
spastor | 0:fcaad0dfa051 | 28 | const uint16_t digital_channels = get_digital_channels(); |
spastor | 0:fcaad0dfa051 | 29 | |
spastor | 0:fcaad0dfa051 | 30 | *dio_value = digital_channels & mask ? High : Low; |
spastor | 0:fcaad0dfa051 | 31 | return Success; |
spastor | 0:fcaad0dfa051 | 32 | } |
spastor | 0:fcaad0dfa051 | 33 | return Failure; |
spastor | 0:fcaad0dfa051 | 34 | } |
spastor | 0:fcaad0dfa051 | 35 | |
spastor | 0:fcaad0dfa051 | 36 | RadioStatus IOSampleZB::get_adc(XBeeZB::IoLine line, uint16_t* const val) const |
spastor | 0:fcaad0dfa051 | 37 | { |
spastor | 0:fcaad0dfa051 | 38 | const uint8_t line_mask = 1 << line; |
spastor | 0:fcaad0dfa051 | 39 | const bool adc_present = line_mask & _analog_mask; |
spastor | 0:fcaad0dfa051 | 40 | if (!adc_present) { |
spastor | 0:fcaad0dfa051 | 41 | return Failure; |
spastor | 0:fcaad0dfa051 | 42 | } |
spastor | 0:fcaad0dfa051 | 43 | |
spastor | 0:fcaad0dfa051 | 44 | uint8_t analog_data_idx = _digital_mask == 0 ? 0 : 2; |
spastor | 0:fcaad0dfa051 | 45 | uint8_t line_sample = 0; |
spastor | 0:fcaad0dfa051 | 46 | |
spastor | 0:fcaad0dfa051 | 47 | while (analog_data_idx < _sampled_data_size) { |
spastor | 0:fcaad0dfa051 | 48 | if (_analog_mask & (1 << line_sample)) { |
spastor | 0:fcaad0dfa051 | 49 | if (line_sample == line) { |
spastor | 0:fcaad0dfa051 | 50 | /* Write the analog value */ |
spastor | 0:fcaad0dfa051 | 51 | *val = UINT16(_sampled_data[analog_data_idx], _sampled_data[analog_data_idx + 1]); |
spastor | 0:fcaad0dfa051 | 52 | break; |
spastor | 0:fcaad0dfa051 | 53 | } |
spastor | 0:fcaad0dfa051 | 54 | analog_data_idx += 2; |
spastor | 0:fcaad0dfa051 | 55 | } |
spastor | 0:fcaad0dfa051 | 56 | line_sample++; |
spastor | 0:fcaad0dfa051 | 57 | } |
spastor | 0:fcaad0dfa051 | 58 | |
spastor | 0:fcaad0dfa051 | 59 | return Success; |
spastor | 0:fcaad0dfa051 | 60 | } |
spastor | 0:fcaad0dfa051 | 61 | |
spastor | 0:fcaad0dfa051 | 62 | inline uint16_t IOSampleZB::get_digital_channels(void) const |
spastor | 0:fcaad0dfa051 | 63 | { |
spastor | 0:fcaad0dfa051 | 64 | if (_digital_mask == 0) { |
spastor | 0:fcaad0dfa051 | 65 | return 0; |
spastor | 0:fcaad0dfa051 | 66 | } |
spastor | 0:fcaad0dfa051 | 67 | return UINT16(_sampled_data[0], _sampled_data[1]); |
spastor | 0:fcaad0dfa051 | 68 | } |
spastor | 0:fcaad0dfa051 | 69 |