Philippe Spino / XBeeLib

project de marde si tu touch le no-homo s'applique pas

Fork of XBeeLib by Digi International Inc.

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?

UserRevisionLine numberNew 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