XBee and XBee-PRO ZigBee RF modules provide cost-effective wireless connectivity to electronic devices. They are interoperable with other ZigBee PRO feature set devices, including devices from other vendors.
Helper/IOSampleDecoder.cpp
- Committer:
- yangcq88517
- Date:
- 2015-10-22
- Revision:
- 0:837e6c48e90d
- Child:
- 2:700dc65ca3b1
File content as of revision 0:837e6c48e90d:
#include "IOSampleDecoder.h" int IOSampleDecoder::XBeeSamplesParse(IOSamples * samples, const char * IOSamplePayload, int offset) { // at least 3 bytes, 1 byte of [number of samples] + 2 bytes of [digital channel mask] and [analog channel mask]. int numofsamples = IOSamplePayload[offset]; if (numofsamples <= 0) return 0; if (samples!= NULL) delete[] samples; // first byte is the number of sample int index = offset + 1; samples = new IOSamples[numofsamples]; int digitMask = ((IOSamplePayload[index] & 0x01) << 8) | IOSamplePayload[index + 1]; int analogMask = IOSamplePayload[index] & 0xFE; // sample start at +2 [mask] index += 2; for (int i = 0; i < numofsamples; i++) { map<Pin, int> * analog = (samples + i)->getAnalogs(); map<Pin, int> * digital = (samples + i)->getDigitals(); if (digitMask != 0) { if ((digitMask & 0x01) == 0x01) (*digital)[XBeePins::P20_AD0_DIO0] = (IOSamplePayload[index + 1] & 0x01) == 0x01 ? 1 : 0; if ((digitMask & 0x02) == 0x02) (*digital)[XBeePins::P19_AD1_DIO1] = (IOSamplePayload[index + 1] & 0x02) == 0x02 ? 1 : 0; if ((digitMask & 0x04) == 0x04) (*digital)[XBeePins::P18_AD2_DIO2] = (IOSamplePayload[index + 1] & 0x04) == 0x04 ? 1 : 0; if ((digitMask & 0x08) == 0x08) (*digital)[XBeePins::P17_AD3_DIO3] = (IOSamplePayload[index + 1] & 0x08) == 0x08 ? 1 : 0; if ((digitMask & 0x10) == 0x10) (*digital)[XBeePins::P11_AD4_DIO4] = (IOSamplePayload[index + 1] & 0x10) == 0x10 ? 1 : 0; if ((digitMask & 0x20) == 0x20) (*digital)[XBeePins::P15_ASSOCIATE_AD5_DIO5] = (IOSamplePayload[index + 1] & 0x20) == 0x20 ? 1 : 0; if ((digitMask & 0x40) == 0x40) (*digital)[XBeePins::P16_RTS_AD6_DIO6] = (IOSamplePayload[index + 1] & 0x40) == 0x40 ? 1 : 0; if ((digitMask & 0x80) == 0x80) (*digital)[XBeePins::P12_CTS_DIO7] = (IOSamplePayload[index + 1] & 0x80) == 0x80 ? 1 : 0; if (((digitMask >> 8) & 0x01) == 0x01) (*digital)[XBeePins::P9_DTR_SLEEP_DIO8] = (IOSamplePayload[index] & 0x01) == 0x01 ? 1 : 0; //skip the 2 [digital sample] index += 2; } if (analogMask != 0) { if ((analogMask & 0x02) == 0x02) (*analog)[XBeePins::P20_AD0_DIO0] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x04) == 0x04) (*analog)[XBeePins::P19_AD1_DIO1] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x08) == 0x08) (*analog)[XBeePins::P18_AD2_DIO2] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x10) == 0x10) (*analog)[XBeePins::P17_AD3_DIO3] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x20) == 0x20) (*analog)[XBeePins::P11_AD4_DIO4] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x40) == 0x40) (*analog)[XBeePins::P15_ASSOCIATE_AD5_DIO5] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; } } return numofsamples; } int IOSampleDecoder::ZigBeeSamplesParse(IOSamples * samples, const char * IOSamplePayload, int offset) { // at least 4 bytes, 1 byte of [number of samples] + 2 bytes of [digital channel mask] + 1 bytes of [analog channel mask]. // the [number of samples] always set to 1. int numofsamples = IOSamplePayload[offset]; if (numofsamples <= 0) return 0; if (samples!= NULL) delete[] samples; int index = offset + 1; int digitMask = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; int analogMask = IOSamplePayload[index++]; samples = new IOSamples[numofsamples]; for (int i = 0; i < numofsamples; i++) { map<Pin, int> * analog = (samples + i)->getAnalogs(); map<Pin, int> * digital = (samples + i)->getDigitals(); if (digitMask != 0) { if ((digitMask & 0x01) == 0x01) (*digital)[ZigBeePins::P20_AD0_DIO0_COMMISSIONONG_BUTTON] = (IOSamplePayload[index + 1] & 0x01) == 0x01 ? 1 : 0; if ((digitMask & 0x02) == 0x02) (*digital)[ZigBeePins::P19_AD1_DIO1] = (IOSamplePayload[index + 1] & 0x02) == 0x02 ? 1 : 0; if ((digitMask & 0x04) == 0x04) (*digital)[ZigBeePins::P18_AD2_DIO2] = (IOSamplePayload[index + 1] & 0x04) == 0x04 ? 1 : 0; if ((digitMask & 0x08) == 0x08) (*digital)[ZigBeePins::P17_AD3_DIO3] = (IOSamplePayload[index + 1] & 0x08) == 0x08 ? 1 : 0; if ((digitMask & 0x10) == 0x10) (*digital)[ZigBeePins::P11_DIO4] = (IOSamplePayload[index + 1] & 0x10) == 0x10 ? 1 : 0; if ((digitMask & 0x20) == 0x20) (*digital)[ZigBeePins::P15_ASSOCIATE_DIO5] = (IOSamplePayload[index + 1] & 0x20) == 0x20 ? 1 : 0; if ((digitMask & 0x40) == 0x40) (*digital)[ZigBeePins::P16_RTS_DIO6] = (IOSamplePayload[index + 1] & 0x40) == 0x40 ? 1 : 0; if ((digitMask & 0x80) == 0x80) (*digital)[ZigBeePins::P12_CTS_DIO7] = (IOSamplePayload[index + 1] & 0x80) == 0x80 ? 1 : 0; if (((digitMask >> 8) & 0x04) == 0x04) (*digital)[ZigBeePins::P6_RSSI_PWM_DIO10] = (IOSamplePayload[index] & 0x04) == 0x04 ? 1 : 0; if (((digitMask >> 8) & 0x08) == 0x08) (*digital)[ZigBeePins::P7_PWM_DIO11] = (IOSamplePayload[index] & 0x08) == 0x08 ? 1 : 0; if (((digitMask >> 8) & 0x10) == 0x10) (*digital)[ZigBeePins::P4_DIO12] = (IOSamplePayload[index] & 0x10) == 0x10 ? 1 : 0; index += 2;// 2 [digital sample] } if (analogMask != 0x00) { //analog mask if ((analogMask & 0x01) == 0x01) (*analog)[ZigBeePins::P20_AD0_DIO0_COMMISSIONONG_BUTTON] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x02) == 0x02) (*analog)[ZigBeePins::P19_AD1_DIO1] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x04) == 0x04) (*analog)[ZigBeePins::P18_AD2_DIO2] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x08) == 0x08) (*analog)[ZigBeePins::P17_AD3_DIO3] = (IOSamplePayload[index++] << 8) | IOSamplePayload[index++]; if ((analogMask & 0x80) == 0x80) (samples + i)->setSupplyVoltage((IOSamplePayload[index++] << 8) | IOSamplePayload[index++]); } } return numofsamples; }