XBee_with_SPI - Xbee API library with support SPI connection. (u…

Users » ban4jp » Code » XBee_with_SPI

Xbee API library with support SPI connection. (use only SPI supported model. see also http://www.digi.com/support/kbase/kbaseresultdetl?id=3362 )

Dependents: XBeeWiFi_SPI_example

Fork of XBee by Suga koubou

XBee.cpp@3:8573b122fa84, 2012-03-08 (annotated)

Committer:: okini3939
Date:: Thu Mar 08 17:41:29 2012 +0000
Revision:: 3:8573b122fa84
Parent:: 2:6efb3541af61
Child:: 4:f6d73acc1f75

Who changed what in which revision?

User	Revision	Line number	New contents of line
okini3939	1:e3b2027e685c	1	/**
okini3939	1:e3b2027e685c	2	* XBee-mbed library
okini3939	1:e3b2027e685c	3	* Modified for mbed, 2011 Suga.
okini3939	1:e3b2027e685c	4	*
okini3939	1:e3b2027e685c	5	*
okini3939	1:e3b2027e685c	6	* Copyright (c) 2009 Andrew Rapp. All rights reserved.
okini3939	1:e3b2027e685c	7	*
okini3939	1:e3b2027e685c	8	* This file is part of XBee-Arduino.
okini3939	1:e3b2027e685c	9	*
okini3939	1:e3b2027e685c	10	* XBee-Arduino is free software: you can redistribute it and/or modify
okini3939	1:e3b2027e685c	11	* it under the terms of the GNU General Public License as published by
okini3939	1:e3b2027e685c	12	* the Free Software Foundation, either version 3 of the License, or
okini3939	1:e3b2027e685c	13	* (at your option) any later version.
okini3939	1:e3b2027e685c	14	*
okini3939	1:e3b2027e685c	15	* XBee-Arduino is distributed in the hope that it will be useful,
okini3939	1:e3b2027e685c	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
okini3939	1:e3b2027e685c	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
okini3939	1:e3b2027e685c	18	* GNU General Public License for more details.
okini3939	1:e3b2027e685c	19	*
okini3939	1:e3b2027e685c	20	* You should have received a copy of the GNU General Public License
okini3939	1:e3b2027e685c	21	* along with XBee-Arduino. If not, see <http://www.gnu.org/licenses/>.
okini3939	1:e3b2027e685c	22	*/
okini3939	1:e3b2027e685c	23
okini3939	3:8573b122fa84	24	/** @file
okini3939	3:8573b122fa84	25	* @brief XBee library for mbed
okini3939	3:8573b122fa84	26	*/
okini3939	3:8573b122fa84	27
okini3939	3:8573b122fa84	28	//#define DEBUG
okini3939	3:8573b122fa84	29	#include "dbg.h"
okini3939	3:8573b122fa84	30
okini3939	1:e3b2027e685c	31	#include "mbed.h"
okini3939	1:e3b2027e685c	32	#include "XBee.h"
okini3939	1:e3b2027e685c	33
okini3939	1:e3b2027e685c	34	XBeeResponse::XBeeResponse() {
okini3939	1:e3b2027e685c	35
okini3939	1:e3b2027e685c	36	}
okini3939	1:e3b2027e685c	37
okini3939	1:e3b2027e685c	38	uint8_t XBeeResponse::getApiId() {
okini3939	1:e3b2027e685c	39	return _apiId;
okini3939	1:e3b2027e685c	40	}
okini3939	1:e3b2027e685c	41
okini3939	1:e3b2027e685c	42	void XBeeResponse::setApiId(uint8_t apiId) {
okini3939	1:e3b2027e685c	43	_apiId = apiId;
okini3939	1:e3b2027e685c	44	}
okini3939	1:e3b2027e685c	45
okini3939	1:e3b2027e685c	46	uint8_t XBeeResponse::getMsbLength() {
okini3939	1:e3b2027e685c	47	return _msbLength;
okini3939	1:e3b2027e685c	48	}
okini3939	1:e3b2027e685c	49
okini3939	1:e3b2027e685c	50	void XBeeResponse::setMsbLength(uint8_t msbLength) {
okini3939	1:e3b2027e685c	51	_msbLength = msbLength;
okini3939	1:e3b2027e685c	52	}
okini3939	1:e3b2027e685c	53
okini3939	1:e3b2027e685c	54	uint8_t XBeeResponse::getLsbLength() {
okini3939	1:e3b2027e685c	55	return _lsbLength;
okini3939	1:e3b2027e685c	56	}
okini3939	1:e3b2027e685c	57
okini3939	1:e3b2027e685c	58	void XBeeResponse::setLsbLength(uint8_t lsbLength) {
okini3939	1:e3b2027e685c	59	_lsbLength = lsbLength;
okini3939	1:e3b2027e685c	60	}
okini3939	1:e3b2027e685c	61
okini3939	1:e3b2027e685c	62	uint8_t XBeeResponse::getChecksum() {
okini3939	1:e3b2027e685c	63	return _checksum;
okini3939	1:e3b2027e685c	64	}
okini3939	1:e3b2027e685c	65
okini3939	1:e3b2027e685c	66	void XBeeResponse::setChecksum(uint8_t checksum) {
okini3939	1:e3b2027e685c	67	_checksum = checksum;
okini3939	1:e3b2027e685c	68	}
okini3939	1:e3b2027e685c	69
okini3939	1:e3b2027e685c	70	uint8_t XBeeResponse::getFrameDataLength() {
okini3939	1:e3b2027e685c	71	return _frameLength;
okini3939	1:e3b2027e685c	72	}
okini3939	1:e3b2027e685c	73
okini3939	1:e3b2027e685c	74	void XBeeResponse::setFrameLength(uint8_t frameLength) {
okini3939	1:e3b2027e685c	75	_frameLength = frameLength;
okini3939	1:e3b2027e685c	76	}
okini3939	1:e3b2027e685c	77
okini3939	1:e3b2027e685c	78	bool XBeeResponse::isAvailable() {
okini3939	1:e3b2027e685c	79	return _complete;
okini3939	1:e3b2027e685c	80	}
okini3939	1:e3b2027e685c	81
okini3939	1:e3b2027e685c	82	void XBeeResponse::setAvailable(bool complete) {
okini3939	1:e3b2027e685c	83	_complete = complete;
okini3939	1:e3b2027e685c	84	}
okini3939	1:e3b2027e685c	85
okini3939	1:e3b2027e685c	86	bool XBeeResponse::isError() {
okini3939	1:e3b2027e685c	87	return _errorCode > 0;
okini3939	1:e3b2027e685c	88	}
okini3939	1:e3b2027e685c	89
okini3939	1:e3b2027e685c	90	uint8_t XBeeResponse::getErrorCode() {
okini3939	1:e3b2027e685c	91	return _errorCode;
okini3939	1:e3b2027e685c	92	}
okini3939	1:e3b2027e685c	93
okini3939	1:e3b2027e685c	94	void XBeeResponse::setErrorCode(uint8_t errorCode) {
okini3939	1:e3b2027e685c	95	_errorCode = errorCode;
okini3939	1:e3b2027e685c	96	}
okini3939	1:e3b2027e685c	97
okini3939	1:e3b2027e685c	98	// copy common fields from xbee response to target response
okini3939	1:e3b2027e685c	99	void XBeeResponse::setCommon(XBeeResponse &target) {
okini3939	1:e3b2027e685c	100	target.setApiId(getApiId());
okini3939	1:e3b2027e685c	101	target.setAvailable(isAvailable());
okini3939	1:e3b2027e685c	102	target.setChecksum(getChecksum());
okini3939	1:e3b2027e685c	103	target.setErrorCode(getErrorCode());
okini3939	1:e3b2027e685c	104	target.setFrameLength(getFrameDataLength());
okini3939	1:e3b2027e685c	105	target.setMsbLength(getMsbLength());
okini3939	1:e3b2027e685c	106	target.setLsbLength(getLsbLength());
okini3939	1:e3b2027e685c	107	}
okini3939	1:e3b2027e685c	108
okini3939	1:e3b2027e685c	109	#ifdef SERIES_2
okini3939	1:e3b2027e685c	110
okini3939	1:e3b2027e685c	111	ZBTxStatusResponse::ZBTxStatusResponse() : FrameIdResponse() {
okini3939	1:e3b2027e685c	112
okini3939	1:e3b2027e685c	113	}
okini3939	1:e3b2027e685c	114
okini3939	1:e3b2027e685c	115	uint16_t ZBTxStatusResponse::getRemoteAddress() {
okini3939	1:e3b2027e685c	116	return (getFrameData()[1] << 8) + getFrameData()[2];
okini3939	1:e3b2027e685c	117	}
okini3939	1:e3b2027e685c	118
okini3939	1:e3b2027e685c	119	uint8_t ZBTxStatusResponse::getTxRetryCount() {
okini3939	1:e3b2027e685c	120	return getFrameData()[3];
okini3939	1:e3b2027e685c	121	}
okini3939	1:e3b2027e685c	122
okini3939	1:e3b2027e685c	123	uint8_t ZBTxStatusResponse::getDeliveryStatus() {
okini3939	1:e3b2027e685c	124	return getFrameData()[4];
okini3939	1:e3b2027e685c	125	}
okini3939	1:e3b2027e685c	126
okini3939	1:e3b2027e685c	127	uint8_t ZBTxStatusResponse::getDiscoveryStatus() {
okini3939	1:e3b2027e685c	128	return getFrameData()[5];
okini3939	1:e3b2027e685c	129	}
okini3939	1:e3b2027e685c	130
okini3939	1:e3b2027e685c	131	bool ZBTxStatusResponse::isSuccess() {
okini3939	1:e3b2027e685c	132	return getDeliveryStatus() == SUCCESS;
okini3939	1:e3b2027e685c	133	}
okini3939	1:e3b2027e685c	134
okini3939	1:e3b2027e685c	135	void XBeeResponse::getZBTxStatusResponse(XBeeResponse &zbXBeeResponse) {
okini3939	1:e3b2027e685c	136
okini3939	1:e3b2027e685c	137	// way off?
okini3939	1:e3b2027e685c	138	ZBTxStatusResponse* zb = static_cast<ZBTxStatusResponse*>(&zbXBeeResponse);
okini3939	1:e3b2027e685c	139	// pass pointer array to subclass
okini3939	1:e3b2027e685c	140	zb->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	141	setCommon(zbXBeeResponse);
okini3939	1:e3b2027e685c	142	}
okini3939	1:e3b2027e685c	143
okini3939	1:e3b2027e685c	144	ZBRxResponse::ZBRxResponse(): RxDataResponse() {
okini3939	1:e3b2027e685c	145	_remoteAddress64 = XBeeAddress64();
okini3939	1:e3b2027e685c	146	}
okini3939	1:e3b2027e685c	147
okini3939	1:e3b2027e685c	148	uint16_t ZBRxResponse::getRemoteAddress16() {
okini3939	1:e3b2027e685c	149	return (getFrameData()[8] << 8) + getFrameData()[9];
okini3939	1:e3b2027e685c	150	}
okini3939	1:e3b2027e685c	151
okini3939	1:e3b2027e685c	152	uint8_t ZBRxResponse::getOption() {
okini3939	1:e3b2027e685c	153	return getFrameData()[10];
okini3939	1:e3b2027e685c	154	}
okini3939	1:e3b2027e685c	155
okini3939	1:e3b2027e685c	156	// markers to read data from packet array. this is the index, so the 12th item in the array
okini3939	1:e3b2027e685c	157	uint8_t ZBRxResponse::getDataOffset() {
okini3939	1:e3b2027e685c	158	return 11;
okini3939	1:e3b2027e685c	159	}
okini3939	1:e3b2027e685c	160
okini3939	1:e3b2027e685c	161	uint8_t ZBRxResponse::getDataLength() {
okini3939	1:e3b2027e685c	162	return getPacketLength() - getDataOffset() - 1;
okini3939	1:e3b2027e685c	163	}
okini3939	1:e3b2027e685c	164
okini3939	1:e3b2027e685c	165	XBeeAddress64& ZBRxResponse::getRemoteAddress64() {
okini3939	1:e3b2027e685c	166	return _remoteAddress64;
okini3939	1:e3b2027e685c	167	}
okini3939	1:e3b2027e685c	168
okini3939	1:e3b2027e685c	169	void XBeeResponse::getZBRxResponse(XBeeResponse &rxResponse) {
okini3939	1:e3b2027e685c	170
okini3939	1:e3b2027e685c	171	ZBRxResponse* zb = static_cast<ZBRxResponse*>(&rxResponse);
okini3939	1:e3b2027e685c	172
okini3939	1:e3b2027e685c	173	//TODO verify response api id matches this api for this response
okini3939	1:e3b2027e685c	174
okini3939	1:e3b2027e685c	175	// pass pointer array to subclass
okini3939	1:e3b2027e685c	176	zb->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	177	setCommon(rxResponse);
okini3939	1:e3b2027e685c	178
okini3939	1:e3b2027e685c	179	zb->getRemoteAddress64().setMsb((uint32_t(getFrameData()[0]) << 24) + (uint32_t(getFrameData()[1]) << 16) + (uint16_t(getFrameData()[2]) << 8) + getFrameData()[3]);
okini3939	1:e3b2027e685c	180	zb->getRemoteAddress64().setLsb((uint32_t(getFrameData()[4]) << 24) + (uint32_t(getFrameData()[5]) << 16) + (uint16_t(getFrameData()[6]) << 8) + (getFrameData()[7]));
okini3939	1:e3b2027e685c	181	}
okini3939	1:e3b2027e685c	182
okini3939	1:e3b2027e685c	183
okini3939	1:e3b2027e685c	184	ZBRxIoSampleResponse::ZBRxIoSampleResponse() : ZBRxResponse() {
okini3939	1:e3b2027e685c	185
okini3939	1:e3b2027e685c	186	}
okini3939	1:e3b2027e685c	187
okini3939	1:e3b2027e685c	188	// 64 + 16 addresses, sample size, option = 12 (index 11), so this starts at 12
okini3939	1:e3b2027e685c	189	uint8_t ZBRxIoSampleResponse::getDigitalMaskMsb() {
okini3939	1:e3b2027e685c	190	return getFrameData()[12] & 0x1c;
okini3939	1:e3b2027e685c	191	}
okini3939	1:e3b2027e685c	192
okini3939	1:e3b2027e685c	193	uint8_t ZBRxIoSampleResponse::getDigitalMaskLsb() {
okini3939	1:e3b2027e685c	194	return getFrameData()[13];
okini3939	1:e3b2027e685c	195	}
okini3939	1:e3b2027e685c	196
okini3939	1:e3b2027e685c	197	uint8_t ZBRxIoSampleResponse::getAnalogMask() {
okini3939	1:e3b2027e685c	198	return getFrameData()[14] & 0x8f;
okini3939	1:e3b2027e685c	199	}
okini3939	1:e3b2027e685c	200
okini3939	1:e3b2027e685c	201	bool ZBRxIoSampleResponse::containsAnalog() {
okini3939	1:e3b2027e685c	202	return getAnalogMask() > 0;
okini3939	1:e3b2027e685c	203	}
okini3939	1:e3b2027e685c	204
okini3939	1:e3b2027e685c	205	bool ZBRxIoSampleResponse::containsDigital() {
okini3939	1:e3b2027e685c	206	return getDigitalMaskMsb() > 0 \|\| getDigitalMaskLsb() > 0;
okini3939	1:e3b2027e685c	207	}
okini3939	1:e3b2027e685c	208
okini3939	1:e3b2027e685c	209	bool ZBRxIoSampleResponse::isAnalogEnabled(uint8_t pin) {
okini3939	1:e3b2027e685c	210	return ((getAnalogMask() >> pin) & 1) == 1;
okini3939	1:e3b2027e685c	211	}
okini3939	1:e3b2027e685c	212
okini3939	1:e3b2027e685c	213	bool ZBRxIoSampleResponse::isDigitalEnabled(uint8_t pin) {
okini3939	1:e3b2027e685c	214	if (pin <= 7) {
okini3939	1:e3b2027e685c	215	// added extra parens to calm avr compiler
okini3939	1:e3b2027e685c	216	return ((getDigitalMaskLsb() >> pin) & 1) == 1;
okini3939	1:e3b2027e685c	217	} else {
okini3939	1:e3b2027e685c	218	return ((getDigitalMaskMsb() >> (pin - 8)) & 1) == 1;
okini3939	1:e3b2027e685c	219	}
okini3939	1:e3b2027e685c	220	}
okini3939	1:e3b2027e685c	221
okini3939	1:e3b2027e685c	222	uint16_t ZBRxIoSampleResponse::getAnalog(uint8_t pin) {
okini3939	1:e3b2027e685c	223	// analog starts 13 bytes after sample size, if no dio enabled
okini3939	1:e3b2027e685c	224	uint8_t start = 15;
okini3939	1:e3b2027e685c	225
okini3939	1:e3b2027e685c	226	if (containsDigital()) {
okini3939	1:e3b2027e685c	227	// make room for digital i/o
okini3939	1:e3b2027e685c	228	start+=2;
okini3939	1:e3b2027e685c	229	}
okini3939	1:e3b2027e685c	230
okini3939	1:e3b2027e685c	231	// std::cout << "spacing is " << static_cast<unsigned int>(spacing) << std::endl;
okini3939	1:e3b2027e685c	232
okini3939	1:e3b2027e685c	233	// start depends on how many pins before this pin are enabled
okini3939	1:e3b2027e685c	234	for (int i = 0; i < pin; i++) {
okini3939	1:e3b2027e685c	235	// if (isAnalogEnabled(pin)) {
okini3939	1:e3b2027e685c	236	if (isAnalogEnabled(i)) {
okini3939	1:e3b2027e685c	237	start+=2;
okini3939	1:e3b2027e685c	238	}
okini3939	1:e3b2027e685c	239	}
okini3939	1:e3b2027e685c	240
okini3939	1:e3b2027e685c	241	// std::cout << "start for analog pin ["<< static_cast<unsigned int>(pin) << "]/sample " << static_cast<unsigned int>(sample) << " is " << static_cast<unsigned int>(start) << std::endl;
okini3939	1:e3b2027e685c	242
okini3939	1:e3b2027e685c	243	// std::cout << "returning index " << static_cast<unsigned int>(getSampleOffset() + start) << " and index " << static_cast<unsigned int>(getSampleOffset() + start + 1) << ", val is " << static_cast<unsigned int>(getFrameData()[getSampleOffset() + start] << 8) << " and " << + static_cast<unsigned int>(getFrameData()[getSampleOffset() + start + 1]) << std::endl;
okini3939	1:e3b2027e685c	244
okini3939	1:e3b2027e685c	245	return (uint16_t)((getFrameData()[start] << 8) + getFrameData()[start + 1]);
okini3939	1:e3b2027e685c	246	}
okini3939	1:e3b2027e685c	247
okini3939	1:e3b2027e685c	248	bool ZBRxIoSampleResponse::isDigitalOn(uint8_t pin) {
okini3939	1:e3b2027e685c	249	if (pin <= 7) {
okini3939	1:e3b2027e685c	250	// D0-7
okini3939	1:e3b2027e685c	251	// DIO LSB is index 5
okini3939	1:e3b2027e685c	252	return ((getFrameData()[16] >> pin) & 1) == 1;
okini3939	1:e3b2027e685c	253	} else {
okini3939	1:e3b2027e685c	254	// D10-12
okini3939	1:e3b2027e685c	255	// DIO MSB is index 4
okini3939	1:e3b2027e685c	256	return ((getFrameData()[15] >> (pin - 8)) & 1) == 1;
okini3939	1:e3b2027e685c	257	}
okini3939	1:e3b2027e685c	258	}
okini3939	1:e3b2027e685c	259
okini3939	1:e3b2027e685c	260	void XBeeResponse::getZBRxIoSampleResponse(XBeeResponse &response) {
okini3939	1:e3b2027e685c	261	ZBRxIoSampleResponse* zb = static_cast<ZBRxIoSampleResponse*>(&response);
okini3939	1:e3b2027e685c	262
okini3939	1:e3b2027e685c	263
okini3939	1:e3b2027e685c	264	// pass pointer array to subclass
okini3939	1:e3b2027e685c	265	zb->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	266	setCommon(response);
okini3939	1:e3b2027e685c	267
okini3939	1:e3b2027e685c	268	zb->getRemoteAddress64().setMsb((uint32_t(getFrameData()[0]) << 24) + (uint32_t(getFrameData()[1]) << 16) + (uint16_t(getFrameData()[2]) << 8) + getFrameData()[3]);
okini3939	1:e3b2027e685c	269	zb->getRemoteAddress64().setLsb((uint32_t(getFrameData()[4]) << 24) + (uint32_t(getFrameData()[5]) << 16) + (uint16_t(getFrameData()[6]) << 8) + (getFrameData()[7]));
okini3939	1:e3b2027e685c	270	}
okini3939	1:e3b2027e685c	271
okini3939	1:e3b2027e685c	272	#endif
okini3939	1:e3b2027e685c	273
okini3939	1:e3b2027e685c	274	#ifdef SERIES_1
okini3939	1:e3b2027e685c	275
okini3939	1:e3b2027e685c	276	RxResponse::RxResponse() : RxDataResponse() {
okini3939	1:e3b2027e685c	277
okini3939	1:e3b2027e685c	278	}
okini3939	1:e3b2027e685c	279
okini3939	1:e3b2027e685c	280	uint16_t Rx16Response::getRemoteAddress16() {
okini3939	1:e3b2027e685c	281	return (getFrameData()[0] << 8) + getFrameData()[1];
okini3939	1:e3b2027e685c	282	}
okini3939	1:e3b2027e685c	283
okini3939	1:e3b2027e685c	284	XBeeAddress64& Rx64Response::getRemoteAddress64() {
okini3939	1:e3b2027e685c	285	return _remoteAddress;
okini3939	1:e3b2027e685c	286	}
okini3939	1:e3b2027e685c	287
okini3939	1:e3b2027e685c	288	Rx64Response::Rx64Response() : RxResponse() {
okini3939	1:e3b2027e685c	289	_remoteAddress = XBeeAddress64();
okini3939	1:e3b2027e685c	290	}
okini3939	1:e3b2027e685c	291
okini3939	1:e3b2027e685c	292	Rx16Response::Rx16Response() : RxResponse() {
okini3939	1:e3b2027e685c	293
okini3939	1:e3b2027e685c	294	}
okini3939	1:e3b2027e685c	295
okini3939	1:e3b2027e685c	296	RxIoSampleBaseResponse::RxIoSampleBaseResponse() : RxResponse() {
okini3939	1:e3b2027e685c	297
okini3939	1:e3b2027e685c	298	}
okini3939	1:e3b2027e685c	299
okini3939	1:e3b2027e685c	300	uint8_t RxIoSampleBaseResponse::getSampleOffset() {
okini3939	1:e3b2027e685c	301	// sample starts 2 bytes after rssi
okini3939	1:e3b2027e685c	302	return getRssiOffset() + 2;
okini3939	1:e3b2027e685c	303	}
okini3939	1:e3b2027e685c	304
okini3939	1:e3b2027e685c	305
okini3939	1:e3b2027e685c	306	uint8_t RxIoSampleBaseResponse::getSampleSize() {
okini3939	1:e3b2027e685c	307	return getFrameData()[getSampleOffset()];
okini3939	1:e3b2027e685c	308	}
okini3939	1:e3b2027e685c	309
okini3939	1:e3b2027e685c	310	bool RxIoSampleBaseResponse::containsAnalog() {
okini3939	1:e3b2027e685c	311	return (getFrameData()[getSampleOffset() + 1] & 0x7e) > 0;
okini3939	1:e3b2027e685c	312	}
okini3939	1:e3b2027e685c	313
okini3939	1:e3b2027e685c	314	bool RxIoSampleBaseResponse::containsDigital() {
okini3939	1:e3b2027e685c	315	return (getFrameData()[getSampleOffset() + 1] & 0x1) > 0 \|\| getFrameData()[getSampleOffset() + 2] > 0;
okini3939	1:e3b2027e685c	316	}
okini3939	1:e3b2027e685c	317
okini3939	1:e3b2027e685c	318	//uint16_t RxIoSampleBaseResponse::getAnalog0(uint8_t sample) {
okini3939	1:e3b2027e685c	319	// return getAnalog(0, sample);
okini3939	1:e3b2027e685c	320	//}
okini3939	1:e3b2027e685c	321
okini3939	1:e3b2027e685c	322	bool RxIoSampleBaseResponse::isAnalogEnabled(uint8_t pin) {
okini3939	1:e3b2027e685c	323	return (((getFrameData()[getSampleOffset() + 1] >> (pin + 1)) & 1) == 1);
okini3939	1:e3b2027e685c	324	}
okini3939	1:e3b2027e685c	325
okini3939	1:e3b2027e685c	326	bool RxIoSampleBaseResponse::isDigitalEnabled(uint8_t pin) {
okini3939	1:e3b2027e685c	327	if (pin < 8) {
okini3939	1:e3b2027e685c	328	return ((getFrameData()[getSampleOffset() + 4] >> pin) & 1) == 1;
okini3939	1:e3b2027e685c	329	} else {
okini3939	1:e3b2027e685c	330	return (getFrameData()[getSampleOffset() + 3] & 1) == 1;
okini3939	1:e3b2027e685c	331	}
okini3939	1:e3b2027e685c	332	}
okini3939	1:e3b2027e685c	333
okini3939	1:e3b2027e685c	334	uint16_t RxIoSampleBaseResponse::getAnalog(uint8_t pin, uint8_t sample) {
okini3939	1:e3b2027e685c	335
okini3939	1:e3b2027e685c	336	// analog starts 3 bytes after sample size, if no dio enabled
okini3939	1:e3b2027e685c	337	uint8_t start = 3;
okini3939	1:e3b2027e685c	338
okini3939	1:e3b2027e685c	339	if (containsDigital()) {
okini3939	1:e3b2027e685c	340	// make room for digital i/o sample (2 bytes per sample)
okini3939	1:e3b2027e685c	341	start+=2*(sample + 1);
okini3939	1:e3b2027e685c	342	}
okini3939	1:e3b2027e685c	343
okini3939	1:e3b2027e685c	344	uint8_t spacing = 0;
okini3939	1:e3b2027e685c	345
okini3939	1:e3b2027e685c	346	// spacing between samples depends on how many are enabled. add one for each analog that's enabled
okini3939	1:e3b2027e685c	347	for (int i = 0; i <= 5; i++) {
okini3939	1:e3b2027e685c	348	if (isAnalogEnabled(i)) {
okini3939	1:e3b2027e685c	349	// each analog is two bytes
okini3939	1:e3b2027e685c	350	spacing+=2;
okini3939	1:e3b2027e685c	351	}
okini3939	1:e3b2027e685c	352	}
okini3939	1:e3b2027e685c	353
okini3939	1:e3b2027e685c	354	// std::cout << "spacing is " << static_cast<unsigned int>(spacing) << std::endl;
okini3939	1:e3b2027e685c	355
okini3939	1:e3b2027e685c	356	// start depends on how many pins before this pin are enabled
okini3939	1:e3b2027e685c	357	for (int i = 0; i < pin; i++) {
okini3939	1:e3b2027e685c	358	if (isAnalogEnabled(pin)) {
okini3939	1:e3b2027e685c	359	start+=2;
okini3939	1:e3b2027e685c	360	}
okini3939	1:e3b2027e685c	361	}
okini3939	1:e3b2027e685c	362
okini3939	1:e3b2027e685c	363	start+= sample * spacing;
okini3939	1:e3b2027e685c	364
okini3939	1:e3b2027e685c	365	// std::cout << "start for analog pin ["<< static_cast<unsigned int>(pin) << "]/sample " << static_cast<unsigned int>(sample) << " is " << static_cast<unsigned int>(start) << std::endl;
okini3939	1:e3b2027e685c	366
okini3939	1:e3b2027e685c	367	// std::cout << "returning index " << static_cast<unsigned int>(getSampleOffset() + start) << " and index " << static_cast<unsigned int>(getSampleOffset() + start + 1) << ", val is " << static_cast<unsigned int>(getFrameData()[getSampleOffset() + start] << 8) << " and " << + static_cast<unsigned int>(getFrameData()[getSampleOffset() + start + 1]) << std::endl;
okini3939	1:e3b2027e685c	368
okini3939	1:e3b2027e685c	369	return (uint16_t)((getFrameData()[getSampleOffset() + start] << 8) + getFrameData()[getSampleOffset() + start + 1]);
okini3939	1:e3b2027e685c	370	}
okini3939	1:e3b2027e685c	371
okini3939	1:e3b2027e685c	372	bool RxIoSampleBaseResponse::isDigitalOn(uint8_t pin, uint8_t sample) {
okini3939	1:e3b2027e685c	373	if (pin < 8) {
okini3939	1:e3b2027e685c	374	return ((getFrameData()[getSampleOffset() + 4] >> pin) & 1) == 1;
okini3939	1:e3b2027e685c	375	} else {
okini3939	1:e3b2027e685c	376	return (getFrameData()[getSampleOffset() + 3] & 1) == 1;
okini3939	1:e3b2027e685c	377	}
okini3939	1:e3b2027e685c	378	}
okini3939	1:e3b2027e685c	379
okini3939	1:e3b2027e685c	380
okini3939	1:e3b2027e685c	381	//bool RxIoSampleBaseResponse::isDigital0On(uint8_t sample) {
okini3939	1:e3b2027e685c	382	// return isDigitalOn(0, sample);
okini3939	1:e3b2027e685c	383	//}
okini3939	1:e3b2027e685c	384
okini3939	1:e3b2027e685c	385	Rx16IoSampleResponse::Rx16IoSampleResponse() : RxIoSampleBaseResponse() {
okini3939	1:e3b2027e685c	386
okini3939	1:e3b2027e685c	387	}
okini3939	1:e3b2027e685c	388
okini3939	1:e3b2027e685c	389	uint16_t Rx16IoSampleResponse::getRemoteAddress16() {
okini3939	1:e3b2027e685c	390	return (uint16_t)((getFrameData()[0] << 8) + getFrameData()[1]);
okini3939	1:e3b2027e685c	391	}
okini3939	1:e3b2027e685c	392
okini3939	1:e3b2027e685c	393	uint8_t Rx16IoSampleResponse::getRssiOffset() {
okini3939	1:e3b2027e685c	394	return 2;
okini3939	1:e3b2027e685c	395	}
okini3939	1:e3b2027e685c	396
okini3939	1:e3b2027e685c	397	void XBeeResponse::getRx16IoSampleResponse(XBeeResponse &response) {
okini3939	1:e3b2027e685c	398	Rx16IoSampleResponse* rx = static_cast<Rx16IoSampleResponse*>(&response);
okini3939	1:e3b2027e685c	399
okini3939	1:e3b2027e685c	400	rx->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	401	setCommon(response);
okini3939	1:e3b2027e685c	402	}
okini3939	1:e3b2027e685c	403
okini3939	1:e3b2027e685c	404
okini3939	1:e3b2027e685c	405	Rx64IoSampleResponse::Rx64IoSampleResponse() : RxIoSampleBaseResponse() {
okini3939	1:e3b2027e685c	406	_remoteAddress = XBeeAddress64();
okini3939	1:e3b2027e685c	407	}
okini3939	1:e3b2027e685c	408
okini3939	1:e3b2027e685c	409	XBeeAddress64& Rx64IoSampleResponse::getRemoteAddress64() {
okini3939	1:e3b2027e685c	410	return _remoteAddress;
okini3939	1:e3b2027e685c	411	}
okini3939	1:e3b2027e685c	412
okini3939	1:e3b2027e685c	413	uint8_t Rx64IoSampleResponse::getRssiOffset() {
okini3939	1:e3b2027e685c	414	return 8;
okini3939	1:e3b2027e685c	415	}
okini3939	1:e3b2027e685c	416
okini3939	1:e3b2027e685c	417	void XBeeResponse::getRx64IoSampleResponse(XBeeResponse &response) {
okini3939	1:e3b2027e685c	418	Rx64IoSampleResponse* rx = static_cast<Rx64IoSampleResponse*>(&response);
okini3939	1:e3b2027e685c	419
okini3939	1:e3b2027e685c	420	rx->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	421	setCommon(response);
okini3939	1:e3b2027e685c	422
okini3939	1:e3b2027e685c	423	rx->getRemoteAddress64().setMsb((uint32_t(getFrameData()[0]) << 24) + (uint32_t(getFrameData()[1]) << 16) + (uint16_t(getFrameData()[2]) << 8) + getFrameData()[3]);
okini3939	1:e3b2027e685c	424	rx->getRemoteAddress64().setLsb((uint32_t(getFrameData()[4]) << 24) + (uint32_t(getFrameData()[5]) << 16) + (uint16_t(getFrameData()[6]) << 8) + getFrameData()[7]);
okini3939	1:e3b2027e685c	425	}
okini3939	1:e3b2027e685c	426
okini3939	1:e3b2027e685c	427	TxStatusResponse::TxStatusResponse() : FrameIdResponse() {
okini3939	1:e3b2027e685c	428
okini3939	1:e3b2027e685c	429	}
okini3939	1:e3b2027e685c	430
okini3939	1:e3b2027e685c	431	uint8_t TxStatusResponse::getStatus() {
okini3939	1:e3b2027e685c	432	return getFrameData()[1];
okini3939	1:e3b2027e685c	433	}
okini3939	1:e3b2027e685c	434
okini3939	1:e3b2027e685c	435	bool TxStatusResponse::isSuccess() {
okini3939	1:e3b2027e685c	436	return getStatus() == SUCCESS;
okini3939	1:e3b2027e685c	437	}
okini3939	1:e3b2027e685c	438
okini3939	1:e3b2027e685c	439	void XBeeResponse::getTxStatusResponse(XBeeResponse &txResponse) {
okini3939	1:e3b2027e685c	440
okini3939	1:e3b2027e685c	441	TxStatusResponse* txStatus = static_cast<TxStatusResponse*>(&txResponse);
okini3939	1:e3b2027e685c	442
okini3939	1:e3b2027e685c	443	// pass pointer array to subclass
okini3939	1:e3b2027e685c	444	txStatus->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	445	setCommon(txResponse);
okini3939	1:e3b2027e685c	446	}
okini3939	1:e3b2027e685c	447
okini3939	1:e3b2027e685c	448	uint8_t RxResponse::getRssi() {
okini3939	1:e3b2027e685c	449	return getFrameData()[getRssiOffset()];
okini3939	1:e3b2027e685c	450	}
okini3939	1:e3b2027e685c	451
okini3939	1:e3b2027e685c	452	uint8_t RxResponse::getOption() {
okini3939	1:e3b2027e685c	453	return getFrameData()[getRssiOffset() + 1];
okini3939	1:e3b2027e685c	454	}
okini3939	1:e3b2027e685c	455
okini3939	1:e3b2027e685c	456	bool RxResponse::isAddressBroadcast() {
okini3939	1:e3b2027e685c	457	return (getOption() & 2) == 2;
okini3939	1:e3b2027e685c	458	}
okini3939	1:e3b2027e685c	459
okini3939	1:e3b2027e685c	460	bool RxResponse::isPanBroadcast() {
okini3939	1:e3b2027e685c	461	return (getOption() & 4) == 4;
okini3939	1:e3b2027e685c	462	}
okini3939	1:e3b2027e685c	463
okini3939	1:e3b2027e685c	464	uint8_t RxResponse::getDataLength() {
okini3939	1:e3b2027e685c	465	return getPacketLength() - getDataOffset() - 1;
okini3939	1:e3b2027e685c	466	}
okini3939	1:e3b2027e685c	467
okini3939	1:e3b2027e685c	468	uint8_t RxResponse::getDataOffset() {
okini3939	1:e3b2027e685c	469	return getRssiOffset() + 2;
okini3939	1:e3b2027e685c	470	}
okini3939	1:e3b2027e685c	471
okini3939	1:e3b2027e685c	472	uint8_t Rx16Response::getRssiOffset() {
okini3939	1:e3b2027e685c	473	return RX_16_RSSI_OFFSET;
okini3939	1:e3b2027e685c	474	}
okini3939	1:e3b2027e685c	475
okini3939	1:e3b2027e685c	476	void XBeeResponse::getRx16Response(XBeeResponse &rx16Response) {
okini3939	1:e3b2027e685c	477
okini3939	1:e3b2027e685c	478	Rx16Response* rx16 = static_cast<Rx16Response*>(&rx16Response);
okini3939	1:e3b2027e685c	479
okini3939	1:e3b2027e685c	480	// pass pointer array to subclass
okini3939	1:e3b2027e685c	481	rx16->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	482	setCommon(rx16Response);
okini3939	1:e3b2027e685c	483
okini3939	1:e3b2027e685c	484	// rx16->getRemoteAddress16().setAddress((getFrameData()[0] << 8) + getFrameData()[1]);
okini3939	1:e3b2027e685c	485	}
okini3939	1:e3b2027e685c	486
okini3939	1:e3b2027e685c	487	uint8_t Rx64Response::getRssiOffset() {
okini3939	1:e3b2027e685c	488	return RX_64_RSSI_OFFSET;
okini3939	1:e3b2027e685c	489	}
okini3939	1:e3b2027e685c	490
okini3939	1:e3b2027e685c	491	void XBeeResponse::getRx64Response(XBeeResponse &rx64Response) {
okini3939	1:e3b2027e685c	492
okini3939	1:e3b2027e685c	493	Rx64Response* rx64 = static_cast<Rx64Response*>(&rx64Response);
okini3939	1:e3b2027e685c	494
okini3939	1:e3b2027e685c	495	// pass pointer array to subclass
okini3939	1:e3b2027e685c	496	rx64->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	497	setCommon(rx64Response);
okini3939	1:e3b2027e685c	498
okini3939	1:e3b2027e685c	499	rx64->getRemoteAddress64().setMsb((uint32_t(getFrameData()[0]) << 24) + (uint32_t(getFrameData()[1]) << 16) + (uint16_t(getFrameData()[2]) << 8) + getFrameData()[3]);
okini3939	1:e3b2027e685c	500	rx64->getRemoteAddress64().setLsb((uint32_t(getFrameData()[4]) << 24) + (uint32_t(getFrameData()[5]) << 16) + (uint16_t(getFrameData()[6]) << 8) + getFrameData()[7]);
okini3939	1:e3b2027e685c	501	}
okini3939	1:e3b2027e685c	502
okini3939	1:e3b2027e685c	503	#endif
okini3939	1:e3b2027e685c	504
okini3939	1:e3b2027e685c	505	RemoteAtCommandResponse::RemoteAtCommandResponse() : AtCommandResponse() {
okini3939	1:e3b2027e685c	506
okini3939	1:e3b2027e685c	507	}
okini3939	1:e3b2027e685c	508
okini3939	1:e3b2027e685c	509	uint8_t* RemoteAtCommandResponse::getCommand() {
okini3939	1:e3b2027e685c	510	return getFrameData() + 11;
okini3939	1:e3b2027e685c	511	}
okini3939	1:e3b2027e685c	512
okini3939	1:e3b2027e685c	513	uint8_t RemoteAtCommandResponse::getStatus() {
okini3939	1:e3b2027e685c	514	return getFrameData()[13];
okini3939	1:e3b2027e685c	515	}
okini3939	1:e3b2027e685c	516
okini3939	1:e3b2027e685c	517	bool RemoteAtCommandResponse::isOk() {
okini3939	1:e3b2027e685c	518	// weird c++ behavior. w/o this method, it calls AtCommandResponse::isOk(), which calls the AtCommandResponse::getStatus, not this.getStatus!!!
okini3939	1:e3b2027e685c	519	return getStatus() == AT_OK;
okini3939	1:e3b2027e685c	520	}
okini3939	1:e3b2027e685c	521
okini3939	1:e3b2027e685c	522	uint8_t RemoteAtCommandResponse::getValueLength() {
okini3939	1:e3b2027e685c	523	return getFrameDataLength() - 14;
okini3939	1:e3b2027e685c	524	}
okini3939	1:e3b2027e685c	525
okini3939	1:e3b2027e685c	526	uint8_t* RemoteAtCommandResponse::getValue() {
okini3939	1:e3b2027e685c	527	if (getValueLength() > 0) {
okini3939	1:e3b2027e685c	528	// value is only included for query commands. set commands does not return a value
okini3939	1:e3b2027e685c	529	return getFrameData() + 14;
okini3939	1:e3b2027e685c	530	}
okini3939	1:e3b2027e685c	531
okini3939	1:e3b2027e685c	532	return NULL;
okini3939	1:e3b2027e685c	533	}
okini3939	1:e3b2027e685c	534
okini3939	1:e3b2027e685c	535	uint16_t RemoteAtCommandResponse::getRemoteAddress16() {
okini3939	1:e3b2027e685c	536	return uint16_t((getFrameData()[9] << 8) + getFrameData()[10]);
okini3939	1:e3b2027e685c	537	}
okini3939	1:e3b2027e685c	538
okini3939	1:e3b2027e685c	539	XBeeAddress64& RemoteAtCommandResponse::getRemoteAddress64() {
okini3939	1:e3b2027e685c	540	return _remoteAddress64;
okini3939	1:e3b2027e685c	541	}
okini3939	1:e3b2027e685c	542
okini3939	1:e3b2027e685c	543	void XBeeResponse::getRemoteAtCommandResponse(XBeeResponse &response) {
okini3939	1:e3b2027e685c	544
okini3939	1:e3b2027e685c	545	// TODO no real need to cast. change arg to match expected class
okini3939	1:e3b2027e685c	546	RemoteAtCommandResponse* at = static_cast<RemoteAtCommandResponse*>(&response);
okini3939	1:e3b2027e685c	547
okini3939	1:e3b2027e685c	548	// pass pointer array to subclass
okini3939	1:e3b2027e685c	549	at->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	550	setCommon(response);
okini3939	1:e3b2027e685c	551
okini3939	1:e3b2027e685c	552	at->getRemoteAddress64().setMsb((uint32_t(getFrameData()[1]) << 24) + (uint32_t(getFrameData()[2]) << 16) + (uint16_t(getFrameData()[3]) << 8) + getFrameData()[4]);
okini3939	1:e3b2027e685c	553	at->getRemoteAddress64().setLsb((uint32_t(getFrameData()[5]) << 24) + (uint32_t(getFrameData()[6]) << 16) + (uint16_t(getFrameData()[7]) << 8) + (getFrameData()[8]));
okini3939	1:e3b2027e685c	554
okini3939	1:e3b2027e685c	555	}
okini3939	1:e3b2027e685c	556
okini3939	1:e3b2027e685c	557	RxDataResponse::RxDataResponse() : XBeeResponse() {
okini3939	1:e3b2027e685c	558
okini3939	1:e3b2027e685c	559	}
okini3939	1:e3b2027e685c	560
okini3939	1:e3b2027e685c	561	uint8_t RxDataResponse::getData(int index) {
okini3939	1:e3b2027e685c	562	return getFrameData()[getDataOffset() + index];
okini3939	1:e3b2027e685c	563	}
okini3939	1:e3b2027e685c	564
okini3939	1:e3b2027e685c	565	uint8_t* RxDataResponse::getData() {
okini3939	1:e3b2027e685c	566	return getFrameData() + getDataOffset();
okini3939	1:e3b2027e685c	567	}
okini3939	1:e3b2027e685c	568
okini3939	1:e3b2027e685c	569	FrameIdResponse::FrameIdResponse() {
okini3939	1:e3b2027e685c	570
okini3939	1:e3b2027e685c	571	}
okini3939	1:e3b2027e685c	572
okini3939	1:e3b2027e685c	573	uint8_t FrameIdResponse::getFrameId() {
okini3939	1:e3b2027e685c	574	return getFrameData()[0];
okini3939	1:e3b2027e685c	575	}
okini3939	1:e3b2027e685c	576
okini3939	1:e3b2027e685c	577
okini3939	1:e3b2027e685c	578	ModemStatusResponse::ModemStatusResponse() {
okini3939	1:e3b2027e685c	579
okini3939	1:e3b2027e685c	580	}
okini3939	1:e3b2027e685c	581
okini3939	1:e3b2027e685c	582	uint8_t ModemStatusResponse::getStatus() {
okini3939	1:e3b2027e685c	583	return getFrameData()[0];
okini3939	1:e3b2027e685c	584	}
okini3939	1:e3b2027e685c	585
okini3939	1:e3b2027e685c	586	void XBeeResponse::getModemStatusResponse(XBeeResponse &modemStatusResponse) {
okini3939	1:e3b2027e685c	587
okini3939	1:e3b2027e685c	588	ModemStatusResponse* modem = static_cast<ModemStatusResponse*>(&modemStatusResponse);
okini3939	1:e3b2027e685c	589
okini3939	1:e3b2027e685c	590	// pass pointer array to subclass
okini3939	1:e3b2027e685c	591	modem->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	592	setCommon(modemStatusResponse);
okini3939	1:e3b2027e685c	593
okini3939	1:e3b2027e685c	594	}
okini3939	1:e3b2027e685c	595
okini3939	1:e3b2027e685c	596	AtCommandResponse::AtCommandResponse() {
okini3939	1:e3b2027e685c	597
okini3939	1:e3b2027e685c	598	}
okini3939	1:e3b2027e685c	599
okini3939	1:e3b2027e685c	600	uint8_t* AtCommandResponse::getCommand() {
okini3939	1:e3b2027e685c	601	return getFrameData() + 1;
okini3939	1:e3b2027e685c	602	}
okini3939	1:e3b2027e685c	603
okini3939	1:e3b2027e685c	604	uint8_t AtCommandResponse::getStatus() {
okini3939	1:e3b2027e685c	605	return getFrameData()[3];
okini3939	1:e3b2027e685c	606	}
okini3939	1:e3b2027e685c	607
okini3939	1:e3b2027e685c	608	uint8_t AtCommandResponse::getValueLength() {
okini3939	1:e3b2027e685c	609	return getFrameDataLength() - 4;
okini3939	1:e3b2027e685c	610	}
okini3939	1:e3b2027e685c	611
okini3939	1:e3b2027e685c	612	uint8_t* AtCommandResponse::getValue() {
okini3939	1:e3b2027e685c	613	if (getValueLength() > 0) {
okini3939	1:e3b2027e685c	614	// value is only included for query commands. set commands does not return a value
okini3939	1:e3b2027e685c	615	return getFrameData() + 4;
okini3939	1:e3b2027e685c	616	}
okini3939	1:e3b2027e685c	617
okini3939	1:e3b2027e685c	618	return NULL;
okini3939	1:e3b2027e685c	619	}
okini3939	1:e3b2027e685c	620
okini3939	1:e3b2027e685c	621	bool AtCommandResponse::isOk() {
okini3939	1:e3b2027e685c	622	return getStatus() == AT_OK;
okini3939	1:e3b2027e685c	623	}
okini3939	1:e3b2027e685c	624
okini3939	1:e3b2027e685c	625	void XBeeResponse::getAtCommandResponse(XBeeResponse &atCommandResponse) {
okini3939	1:e3b2027e685c	626
okini3939	1:e3b2027e685c	627	AtCommandResponse* at = static_cast<AtCommandResponse*>(&atCommandResponse);
okini3939	1:e3b2027e685c	628
okini3939	1:e3b2027e685c	629	// pass pointer array to subclass
okini3939	1:e3b2027e685c	630	at->setFrameData(getFrameData());
okini3939	1:e3b2027e685c	631	setCommon(atCommandResponse);
okini3939	1:e3b2027e685c	632	}
okini3939	1:e3b2027e685c	633
okini3939	1:e3b2027e685c	634	uint16_t XBeeResponse::getPacketLength() {
okini3939	1:e3b2027e685c	635	return ((_msbLength << 8) & 0xff) + (_lsbLength & 0xff);
okini3939	1:e3b2027e685c	636	}
okini3939	1:e3b2027e685c	637
okini3939	1:e3b2027e685c	638	uint8_t* XBeeResponse::getFrameData() {
okini3939	1:e3b2027e685c	639	return _frameDataPtr;
okini3939	1:e3b2027e685c	640	}
okini3939	1:e3b2027e685c	641
okini3939	1:e3b2027e685c	642	void XBeeResponse::setFrameData(uint8_t* frameDataPtr) {
okini3939	1:e3b2027e685c	643	_frameDataPtr = frameDataPtr;
okini3939	1:e3b2027e685c	644	}
okini3939	1:e3b2027e685c	645
okini3939	1:e3b2027e685c	646	void XBeeResponse::init() {
okini3939	1:e3b2027e685c	647	_complete = false;
okini3939	1:e3b2027e685c	648	_errorCode = NO_ERROR;
okini3939	1:e3b2027e685c	649	_checksum = 0;
okini3939	1:e3b2027e685c	650	}
okini3939	1:e3b2027e685c	651
okini3939	1:e3b2027e685c	652	void XBeeResponse::reset() {
okini3939	1:e3b2027e685c	653	init();
okini3939	1:e3b2027e685c	654	_apiId = 0;
okini3939	1:e3b2027e685c	655	_msbLength = 0;
okini3939	1:e3b2027e685c	656	_lsbLength = 0;
okini3939	1:e3b2027e685c	657	_checksum = 0;
okini3939	1:e3b2027e685c	658	_frameLength = 0;
okini3939	1:e3b2027e685c	659
okini3939	1:e3b2027e685c	660	for (int i = 0; i < MAX_FRAME_DATA_SIZE; i++) {
okini3939	1:e3b2027e685c	661	getFrameData()[i] = 0;
okini3939	1:e3b2027e685c	662	}
okini3939	1:e3b2027e685c	663	}
okini3939	1:e3b2027e685c	664
okini3939	1:e3b2027e685c	665	void XBee::resetResponse() {
okini3939	1:e3b2027e685c	666	_pos = 0;
okini3939	1:e3b2027e685c	667	_escape = false;
okini3939	1:e3b2027e685c	668	_response.reset();
okini3939	1:e3b2027e685c	669	}
okini3939	1:e3b2027e685c	670
okini3939	2:6efb3541af61	671	XBee::XBee(PinName p_tx, PinName p_rx): _xbee(p_tx, p_rx) {
okini3939	1:e3b2027e685c	672	_pos = 0;
okini3939	1:e3b2027e685c	673	_escape = false;
okini3939	1:e3b2027e685c	674	_checksumTotal = 0;
okini3939	1:e3b2027e685c	675	_nextFrameId = 0;
okini3939	3:8573b122fa84	676	_cts = NULL;
okini3939	3:8573b122fa84	677
okini3939	3:8573b122fa84	678	_response.init();
okini3939	3:8573b122fa84	679	_response.setFrameData(_responseFrameData);
okini3939	3:8573b122fa84	680	}
okini3939	3:8573b122fa84	681
okini3939	3:8573b122fa84	682	XBee::XBee(PinName p_tx, PinName p_rx, PinName p_cts): _xbee(p_tx, p_rx) {
okini3939	3:8573b122fa84	683	_pos = 0;
okini3939	3:8573b122fa84	684	_escape = false;
okini3939	3:8573b122fa84	685	_checksumTotal = 0;
okini3939	3:8573b122fa84	686	_nextFrameId = 0;
okini3939	3:8573b122fa84	687	_cts = new DigitalIn(p_cts);
okini3939	1:e3b2027e685c	688
okini3939	1:e3b2027e685c	689	_response.init();
okini3939	1:e3b2027e685c	690	_response.setFrameData(_responseFrameData);
okini3939	1:e3b2027e685c	691	}
okini3939	1:e3b2027e685c	692
okini3939	1:e3b2027e685c	693	uint8_t XBee::getNextFrameId() {
okini3939	1:e3b2027e685c	694
okini3939	1:e3b2027e685c	695	_nextFrameId++;
okini3939	1:e3b2027e685c	696
okini3939	1:e3b2027e685c	697	if (_nextFrameId == 0) {
okini3939	1:e3b2027e685c	698	// can't send 0 because that disables status response
okini3939	1:e3b2027e685c	699	_nextFrameId = 1;
okini3939	1:e3b2027e685c	700	}
okini3939	1:e3b2027e685c	701
okini3939	1:e3b2027e685c	702	return _nextFrameId;
okini3939	1:e3b2027e685c	703	}
okini3939	1:e3b2027e685c	704
okini3939	1:e3b2027e685c	705	void XBee::begin(long baud) {
okini3939	1:e3b2027e685c	706	_xbee.baud(baud);
okini3939	1:e3b2027e685c	707	}
okini3939	1:e3b2027e685c	708
okini3939	1:e3b2027e685c	709	/*
okini3939	1:e3b2027e685c	710	void XBee::setSerial(HardwareSerial serial) {
okini3939	1:e3b2027e685c	711	Serial = serial;
okini3939	1:e3b2027e685c	712	}
okini3939	1:e3b2027e685c	713	*/
okini3939	1:e3b2027e685c	714
okini3939	1:e3b2027e685c	715	XBeeResponse& XBee::getResponse() {
okini3939	1:e3b2027e685c	716	return _response;
okini3939	1:e3b2027e685c	717	}
okini3939	1:e3b2027e685c	718
okini3939	1:e3b2027e685c	719	// TODO how to convert response to proper subclass?
okini3939	1:e3b2027e685c	720	void XBee::getResponse(XBeeResponse &response) {
okini3939	1:e3b2027e685c	721
okini3939	1:e3b2027e685c	722	response.setMsbLength(_response.getMsbLength());
okini3939	1:e3b2027e685c	723	response.setLsbLength(_response.getLsbLength());
okini3939	1:e3b2027e685c	724	response.setApiId(_response.getApiId());
okini3939	1:e3b2027e685c	725	response.setFrameLength(_response.getFrameDataLength());
okini3939	1:e3b2027e685c	726
okini3939	1:e3b2027e685c	727	response.setFrameData(_response.getFrameData());
okini3939	1:e3b2027e685c	728	}
okini3939	1:e3b2027e685c	729
okini3939	1:e3b2027e685c	730	void XBee::readPacketUntilAvailable() {
okini3939	1:e3b2027e685c	731	while (!(getResponse().isAvailable() \|\| getResponse().isError())) {
okini3939	1:e3b2027e685c	732	// read some more
okini3939	1:e3b2027e685c	733	readPacket();
okini3939	1:e3b2027e685c	734	}
okini3939	1:e3b2027e685c	735	}
okini3939	1:e3b2027e685c	736
okini3939	1:e3b2027e685c	737	bool XBee::readPacket(int timeout) {
okini3939	1:e3b2027e685c	738	Timer t;
okini3939	1:e3b2027e685c	739
okini3939	1:e3b2027e685c	740	if (timeout < 0) {
okini3939	1:e3b2027e685c	741	return false;
okini3939	1:e3b2027e685c	742	}
okini3939	1:e3b2027e685c	743
okini3939	1:e3b2027e685c	744	/*
okini3939	1:e3b2027e685c	745	unsigned long start = millis();
okini3939	1:e3b2027e685c	746
okini3939	1:e3b2027e685c	747	while (int((millis() - start)) < timeout) {
okini3939	1:e3b2027e685c	748	*/
okini3939	3:8573b122fa84	749	t.reset();
okini3939	1:e3b2027e685c	750	t.start();
okini3939	1:e3b2027e685c	751	while (t.read_ms() < timeout) {
okini3939	1:e3b2027e685c	752	readPacket();
okini3939	1:e3b2027e685c	753
okini3939	1:e3b2027e685c	754	if (getResponse().isAvailable()) {
okini3939	1:e3b2027e685c	755	t.stop();
okini3939	1:e3b2027e685c	756	return true;
okini3939	1:e3b2027e685c	757	} else if (getResponse().isError()) {
okini3939	1:e3b2027e685c	758	t.stop();
okini3939	1:e3b2027e685c	759	return false;
okini3939	1:e3b2027e685c	760	}
okini3939	1:e3b2027e685c	761	}
okini3939	1:e3b2027e685c	762
okini3939	1:e3b2027e685c	763	// timed out
okini3939	1:e3b2027e685c	764	t.stop();
okini3939	1:e3b2027e685c	765	return false;
okini3939	1:e3b2027e685c	766	}
okini3939	1:e3b2027e685c	767
okini3939	1:e3b2027e685c	768	void XBee::readPacket() {
okini3939	1:e3b2027e685c	769	// reset previous response
okini3939	1:e3b2027e685c	770	if (_response.isAvailable() \|\| _response.isError()) {
okini3939	1:e3b2027e685c	771	// discard previous packet and start over
okini3939	1:e3b2027e685c	772	resetResponse();
okini3939	1:e3b2027e685c	773	}
okini3939	1:e3b2027e685c	774
okini3939	1:e3b2027e685c	775	while (_xbee.readable()) {
okini3939	1:e3b2027e685c	776
okini3939	1:e3b2027e685c	777	b = _xbee.getc();
okini3939	1:e3b2027e685c	778
okini3939	1:e3b2027e685c	779	if (_pos > 0 && b == START_BYTE && ATAP == 2) {
okini3939	1:e3b2027e685c	780	// new packet start before previous packeted completed -- discard previous packet and start over
okini3939	1:e3b2027e685c	781	_response.setErrorCode(UNEXPECTED_START_BYTE);
okini3939	1:e3b2027e685c	782	return;
okini3939	1:e3b2027e685c	783	}
okini3939	1:e3b2027e685c	784
okini3939	1:e3b2027e685c	785	if (_pos > 0 && b == ESCAPE) {
okini3939	1:e3b2027e685c	786	if (_xbee.readable()) {
okini3939	1:e3b2027e685c	787	b = _xbee.getc();
okini3939	1:e3b2027e685c	788	b = 0x20 ^ b;
okini3939	1:e3b2027e685c	789	} else {
okini3939	1:e3b2027e685c	790	// escape byte. next byte will be
okini3939	1:e3b2027e685c	791	_escape = true;
okini3939	1:e3b2027e685c	792	continue;
okini3939	1:e3b2027e685c	793	}
okini3939	1:e3b2027e685c	794	}
okini3939	3:8573b122fa84	795	DBG("%02x_", b);
okini3939	1:e3b2027e685c	796
okini3939	1:e3b2027e685c	797	if (_escape == true) {
okini3939	1:e3b2027e685c	798	b = 0x20 ^ b;
okini3939	1:e3b2027e685c	799	_escape = false;
okini3939	1:e3b2027e685c	800	}
okini3939	1:e3b2027e685c	801
okini3939	1:e3b2027e685c	802	// checksum includes all bytes starting with api id
okini3939	1:e3b2027e685c	803	if (_pos >= API_ID_INDEX) {
okini3939	1:e3b2027e685c	804	_checksumTotal+= b;
okini3939	1:e3b2027e685c	805	}
okini3939	1:e3b2027e685c	806
okini3939	1:e3b2027e685c	807	switch(_pos) {
okini3939	1:e3b2027e685c	808	case 0:
okini3939	1:e3b2027e685c	809	if (b == START_BYTE) {
okini3939	1:e3b2027e685c	810	_pos++;
okini3939	1:e3b2027e685c	811	}
okini3939	1:e3b2027e685c	812
okini3939	1:e3b2027e685c	813	break;
okini3939	1:e3b2027e685c	814	case 1:
okini3939	1:e3b2027e685c	815	// length msb
okini3939	1:e3b2027e685c	816	_response.setMsbLength(b);
okini3939	1:e3b2027e685c	817	_pos++;
okini3939	1:e3b2027e685c	818
okini3939	1:e3b2027e685c	819	break;
okini3939	1:e3b2027e685c	820	case 2:
okini3939	1:e3b2027e685c	821	// length lsb
okini3939	1:e3b2027e685c	822	_response.setLsbLength(b);
okini3939	1:e3b2027e685c	823	_pos++;
okini3939	1:e3b2027e685c	824
okini3939	1:e3b2027e685c	825	break;
okini3939	1:e3b2027e685c	826	case 3:
okini3939	1:e3b2027e685c	827	_response.setApiId(b);
okini3939	1:e3b2027e685c	828	_pos++;
okini3939	1:e3b2027e685c	829
okini3939	1:e3b2027e685c	830	break;
okini3939	1:e3b2027e685c	831	default:
okini3939	1:e3b2027e685c	832	// starts at fifth byte
okini3939	1:e3b2027e685c	833
okini3939	1:e3b2027e685c	834	if (_pos > MAX_FRAME_DATA_SIZE) {
okini3939	1:e3b2027e685c	835	// exceed max size. should never occur
okini3939	1:e3b2027e685c	836	_response.setErrorCode(PACKET_EXCEEDS_BYTE_ARRAY_LENGTH);
okini3939	1:e3b2027e685c	837	return;
okini3939	1:e3b2027e685c	838	}
okini3939	1:e3b2027e685c	839
okini3939	1:e3b2027e685c	840	// check if we're at the end of the packet
okini3939	1:e3b2027e685c	841	// packet length does not include start, length, or checksum bytes, so add 3
okini3939	1:e3b2027e685c	842	if (_pos == (_response.getPacketLength() + 3)) {
okini3939	1:e3b2027e685c	843	// verify checksum
okini3939	1:e3b2027e685c	844
okini3939	1:e3b2027e685c	845	//std::cout << "read checksum " << static_cast<unsigned int>(b) << " at pos " << static_cast<unsigned int>(_pos) << std::endl;
okini3939	1:e3b2027e685c	846
okini3939	1:e3b2027e685c	847	if ((_checksumTotal & 0xff) == 0xff) {
okini3939	1:e3b2027e685c	848	_response.setChecksum(b);
okini3939	1:e3b2027e685c	849	_response.setAvailable(true);
okini3939	1:e3b2027e685c	850
okini3939	1:e3b2027e685c	851	_response.setErrorCode(NO_ERROR);
okini3939	1:e3b2027e685c	852	} else {
okini3939	1:e3b2027e685c	853	// checksum failed
okini3939	1:e3b2027e685c	854	_response.setErrorCode(CHECKSUM_FAILURE);
okini3939	1:e3b2027e685c	855	}
okini3939	1:e3b2027e685c	856
okini3939	1:e3b2027e685c	857	// minus 4 because we start after start,msb,lsb,api and up to but not including checksum
okini3939	1:e3b2027e685c	858	// e.g. if frame was one byte, _pos=4 would be the byte, pos=5 is the checksum, where end stop reading
okini3939	1:e3b2027e685c	859	_response.setFrameLength(_pos - 4);
okini3939	1:e3b2027e685c	860
okini3939	1:e3b2027e685c	861	// reset state vars
okini3939	1:e3b2027e685c	862	_pos = 0;
okini3939	1:e3b2027e685c	863
okini3939	1:e3b2027e685c	864	_checksumTotal = 0;
okini3939	1:e3b2027e685c	865
okini3939	1:e3b2027e685c	866	return;
okini3939	1:e3b2027e685c	867	} else {
okini3939	1:e3b2027e685c	868	// add to packet array, starting with the fourth byte of the apiFrame
okini3939	1:e3b2027e685c	869	_response.getFrameData()[_pos - 4] = b;
okini3939	1:e3b2027e685c	870	_pos++;
okini3939	1:e3b2027e685c	871	}
okini3939	1:e3b2027e685c	872	}
okini3939	1:e3b2027e685c	873	}
okini3939	1:e3b2027e685c	874	}
okini3939	1:e3b2027e685c	875
okini3939	1:e3b2027e685c	876	// it's peanut butter jelly time!!
okini3939	1:e3b2027e685c	877
okini3939	1:e3b2027e685c	878	XBeeRequest::XBeeRequest(uint8_t apiId, uint8_t frameId) {
okini3939	1:e3b2027e685c	879	_apiId = apiId;
okini3939	1:e3b2027e685c	880	_frameId = frameId;
okini3939	1:e3b2027e685c	881	}
okini3939	1:e3b2027e685c	882
okini3939	1:e3b2027e685c	883	void XBeeRequest::setFrameId(uint8_t frameId) {
okini3939	1:e3b2027e685c	884	_frameId = frameId;
okini3939	1:e3b2027e685c	885	}
okini3939	1:e3b2027e685c	886
okini3939	1:e3b2027e685c	887	uint8_t XBeeRequest::getFrameId() {
okini3939	1:e3b2027e685c	888	return _frameId;
okini3939	1:e3b2027e685c	889	}
okini3939	1:e3b2027e685c	890
okini3939	1:e3b2027e685c	891	uint8_t XBeeRequest::getApiId() {
okini3939	1:e3b2027e685c	892	return _apiId;
okini3939	1:e3b2027e685c	893	}
okini3939	1:e3b2027e685c	894
okini3939	1:e3b2027e685c	895	void XBeeRequest::setApiId(uint8_t apiId) {
okini3939	1:e3b2027e685c	896	_apiId = apiId;
okini3939	1:e3b2027e685c	897	}
okini3939	1:e3b2027e685c	898
okini3939	1:e3b2027e685c	899	//void XBeeRequest::reset() {
okini3939	1:e3b2027e685c	900	// _frameId = DEFAULT_FRAME_ID;
okini3939	1:e3b2027e685c	901	//}
okini3939	1:e3b2027e685c	902
okini3939	1:e3b2027e685c	903	//uint8_t XBeeRequest::getPayloadOffset() {
okini3939	1:e3b2027e685c	904	// return _payloadOffset;
okini3939	1:e3b2027e685c	905	//}
okini3939	1:e3b2027e685c	906	//
okini3939	1:e3b2027e685c	907	//uint8_t XBeeRequest::setPayloadOffset(uint8_t payloadOffset) {
okini3939	1:e3b2027e685c	908	// _payloadOffset = payloadOffset;
okini3939	1:e3b2027e685c	909	//}
okini3939	1:e3b2027e685c	910
okini3939	1:e3b2027e685c	911
okini3939	1:e3b2027e685c	912	PayloadRequest::PayloadRequest(uint8_t apiId, uint8_t frameId, uint8_t *payload, uint8_t payloadLength) : XBeeRequest(apiId, frameId) {
okini3939	1:e3b2027e685c	913	_payloadPtr = payload;
okini3939	1:e3b2027e685c	914	_payloadLength = payloadLength;
okini3939	1:e3b2027e685c	915	}
okini3939	1:e3b2027e685c	916
okini3939	1:e3b2027e685c	917	uint8_t* PayloadRequest::getPayload() {
okini3939	1:e3b2027e685c	918	return _payloadPtr;
okini3939	1:e3b2027e685c	919	}
okini3939	1:e3b2027e685c	920
okini3939	1:e3b2027e685c	921	void PayloadRequest::setPayload(uint8_t* payload) {
okini3939	1:e3b2027e685c	922	_payloadPtr = payload;
okini3939	1:e3b2027e685c	923	}
okini3939	1:e3b2027e685c	924
okini3939	1:e3b2027e685c	925	uint8_t PayloadRequest::getPayloadLength() {
okini3939	1:e3b2027e685c	926	return _payloadLength;
okini3939	1:e3b2027e685c	927	}
okini3939	1:e3b2027e685c	928
okini3939	1:e3b2027e685c	929	void PayloadRequest::setPayloadLength(uint8_t payloadLength) {
okini3939	1:e3b2027e685c	930	_payloadLength = payloadLength;
okini3939	1:e3b2027e685c	931	}
okini3939	1:e3b2027e685c	932
okini3939	1:e3b2027e685c	933
okini3939	1:e3b2027e685c	934	XBeeAddress::XBeeAddress() {
okini3939	1:e3b2027e685c	935
okini3939	1:e3b2027e685c	936	}
okini3939	1:e3b2027e685c	937
okini3939	1:e3b2027e685c	938	XBeeAddress64::XBeeAddress64() : XBeeAddress() {
okini3939	1:e3b2027e685c	939
okini3939	1:e3b2027e685c	940	}
okini3939	1:e3b2027e685c	941
okini3939	1:e3b2027e685c	942	XBeeAddress64::XBeeAddress64(uint32_t msb, uint32_t lsb) : XBeeAddress() {
okini3939	1:e3b2027e685c	943	_msb = msb;
okini3939	1:e3b2027e685c	944	_lsb = lsb;
okini3939	1:e3b2027e685c	945	}
okini3939	1:e3b2027e685c	946
okini3939	1:e3b2027e685c	947	uint32_t XBeeAddress64::getMsb() {
okini3939	1:e3b2027e685c	948	return _msb;
okini3939	1:e3b2027e685c	949	}
okini3939	1:e3b2027e685c	950
okini3939	1:e3b2027e685c	951	void XBeeAddress64::setMsb(uint32_t msb) {
okini3939	1:e3b2027e685c	952	_msb = msb;
okini3939	1:e3b2027e685c	953	}
okini3939	1:e3b2027e685c	954
okini3939	1:e3b2027e685c	955	uint32_t XBeeAddress64::getLsb() {
okini3939	1:e3b2027e685c	956	return _lsb;
okini3939	1:e3b2027e685c	957	}
okini3939	1:e3b2027e685c	958
okini3939	1:e3b2027e685c	959	void XBeeAddress64::setLsb(uint32_t lsb) {
okini3939	1:e3b2027e685c	960	_lsb = lsb;
okini3939	1:e3b2027e685c	961	}
okini3939	1:e3b2027e685c	962
okini3939	1:e3b2027e685c	963
okini3939	1:e3b2027e685c	964	#ifdef SERIES_2
okini3939	1:e3b2027e685c	965
okini3939	1:e3b2027e685c	966	ZBTxRequest::ZBTxRequest() : PayloadRequest(ZB_TX_REQUEST, DEFAULT_FRAME_ID, NULL, 0) {
okini3939	1:e3b2027e685c	967
okini3939	1:e3b2027e685c	968	}
okini3939	1:e3b2027e685c	969
okini3939	1:e3b2027e685c	970	ZBTxRequest::ZBTxRequest(XBeeAddress64 &addr64, uint16_t addr16, uint8_t broadcastRadius, uint8_t option, uint8_t *data, uint8_t dataLength, uint8_t frameId): PayloadRequest(ZB_TX_REQUEST, frameId, data, dataLength) {
okini3939	1:e3b2027e685c	971	_addr64 = addr64;
okini3939	1:e3b2027e685c	972	_addr16 = addr16;
okini3939	1:e3b2027e685c	973	_broadcastRadius = broadcastRadius;
okini3939	1:e3b2027e685c	974	_option = option;
okini3939	1:e3b2027e685c	975	}
okini3939	1:e3b2027e685c	976
okini3939	1:e3b2027e685c	977	ZBTxRequest::ZBTxRequest(XBeeAddress64 &addr64, uint8_t *data, uint8_t dataLength): PayloadRequest(ZB_TX_REQUEST, DEFAULT_FRAME_ID, data, dataLength) {
okini3939	1:e3b2027e685c	978	_addr64 = addr64;
okini3939	1:e3b2027e685c	979	_addr16 = ZB_BROADCAST_ADDRESS;
okini3939	1:e3b2027e685c	980	_broadcastRadius = ZB_BROADCAST_RADIUS_MAX_HOPS;
okini3939	1:e3b2027e685c	981	_option = ZB_TX_UNICAST;
okini3939	1:e3b2027e685c	982	}
okini3939	1:e3b2027e685c	983
okini3939	1:e3b2027e685c	984	uint8_t ZBTxRequest::getFrameData(uint8_t pos) {
okini3939	1:e3b2027e685c	985	if (pos == 0) {
okini3939	1:e3b2027e685c	986	return (_addr64.getMsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	987	} else if (pos == 1) {
okini3939	1:e3b2027e685c	988	return (_addr64.getMsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	989	} else if (pos == 2) {
okini3939	1:e3b2027e685c	990	return (_addr64.getMsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	991	} else if (pos == 3) {
okini3939	1:e3b2027e685c	992	return _addr64.getMsb() & 0xff;
okini3939	1:e3b2027e685c	993	} else if (pos == 4) {
okini3939	1:e3b2027e685c	994	return (_addr64.getLsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	995	} else if (pos == 5) {
okini3939	1:e3b2027e685c	996	return (_addr64.getLsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	997	} else if (pos == 6) {
okini3939	1:e3b2027e685c	998	return (_addr64.getLsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	999	} else if (pos == 7) {
okini3939	1:e3b2027e685c	1000	return _addr64.getLsb() & 0xff;
okini3939	1:e3b2027e685c	1001	} else if (pos == 8) {
okini3939	1:e3b2027e685c	1002	return (_addr16 >> 8) & 0xff;
okini3939	1:e3b2027e685c	1003	} else if (pos == 9) {
okini3939	1:e3b2027e685c	1004	return _addr16 & 0xff;
okini3939	1:e3b2027e685c	1005	} else if (pos == 10) {
okini3939	1:e3b2027e685c	1006	return _broadcastRadius;
okini3939	1:e3b2027e685c	1007	} else if (pos == 11) {
okini3939	1:e3b2027e685c	1008	return _option;
okini3939	1:e3b2027e685c	1009	} else {
okini3939	1:e3b2027e685c	1010	return getPayload()[pos - ZB_TX_API_LENGTH];
okini3939	1:e3b2027e685c	1011	}
okini3939	1:e3b2027e685c	1012	}
okini3939	1:e3b2027e685c	1013
okini3939	1:e3b2027e685c	1014	uint8_t ZBTxRequest::getFrameDataLength() {
okini3939	1:e3b2027e685c	1015	return ZB_TX_API_LENGTH + getPayloadLength();
okini3939	1:e3b2027e685c	1016	}
okini3939	1:e3b2027e685c	1017
okini3939	1:e3b2027e685c	1018	XBeeAddress64& ZBTxRequest::getAddress64() {
okini3939	1:e3b2027e685c	1019	return _addr64;
okini3939	1:e3b2027e685c	1020	}
okini3939	1:e3b2027e685c	1021
okini3939	1:e3b2027e685c	1022	uint16_t ZBTxRequest::getAddress16() {
okini3939	1:e3b2027e685c	1023	return _addr16;
okini3939	1:e3b2027e685c	1024	}
okini3939	1:e3b2027e685c	1025
okini3939	1:e3b2027e685c	1026	uint8_t ZBTxRequest::getBroadcastRadius() {
okini3939	1:e3b2027e685c	1027	return _broadcastRadius;
okini3939	1:e3b2027e685c	1028	}
okini3939	1:e3b2027e685c	1029
okini3939	1:e3b2027e685c	1030	uint8_t ZBTxRequest::getOption() {
okini3939	1:e3b2027e685c	1031	return _option;
okini3939	1:e3b2027e685c	1032	}
okini3939	1:e3b2027e685c	1033
okini3939	1:e3b2027e685c	1034	void ZBTxRequest::setAddress64(XBeeAddress64& addr64) {
okini3939	1:e3b2027e685c	1035	_addr64 = addr64;
okini3939	1:e3b2027e685c	1036	}
okini3939	1:e3b2027e685c	1037
okini3939	1:e3b2027e685c	1038	void ZBTxRequest::setAddress16(uint16_t addr16) {
okini3939	1:e3b2027e685c	1039	_addr16 = addr16;
okini3939	1:e3b2027e685c	1040	}
okini3939	1:e3b2027e685c	1041
okini3939	1:e3b2027e685c	1042	void ZBTxRequest::setBroadcastRadius(uint8_t broadcastRadius) {
okini3939	1:e3b2027e685c	1043	_broadcastRadius = broadcastRadius;
okini3939	1:e3b2027e685c	1044	}
okini3939	1:e3b2027e685c	1045
okini3939	1:e3b2027e685c	1046	void ZBTxRequest::setOption(uint8_t option) {
okini3939	1:e3b2027e685c	1047	_option = option;
okini3939	1:e3b2027e685c	1048	}
okini3939	1:e3b2027e685c	1049
okini3939	1:e3b2027e685c	1050	#endif
okini3939	1:e3b2027e685c	1051
okini3939	1:e3b2027e685c	1052	#ifdef SERIES_1
okini3939	1:e3b2027e685c	1053
okini3939	1:e3b2027e685c	1054	Tx16Request::Tx16Request() : PayloadRequest(TX_16_REQUEST, DEFAULT_FRAME_ID, NULL, 0) {
okini3939	1:e3b2027e685c	1055
okini3939	1:e3b2027e685c	1056	}
okini3939	1:e3b2027e685c	1057
okini3939	1:e3b2027e685c	1058	Tx16Request::Tx16Request(uint16_t addr16, uint8_t option, uint8_t *data, uint8_t dataLength, uint8_t frameId) : PayloadRequest(TX_16_REQUEST, frameId, data, dataLength) {
okini3939	1:e3b2027e685c	1059	_addr16 = addr16;
okini3939	1:e3b2027e685c	1060	_option = option;
okini3939	1:e3b2027e685c	1061	}
okini3939	1:e3b2027e685c	1062
okini3939	1:e3b2027e685c	1063	Tx16Request::Tx16Request(uint16_t addr16, uint8_t *data, uint8_t dataLength) : PayloadRequest(TX_16_REQUEST, DEFAULT_FRAME_ID, data, dataLength) {
okini3939	1:e3b2027e685c	1064	_addr16 = addr16;
okini3939	1:e3b2027e685c	1065	_option = ACK_OPTION;
okini3939	1:e3b2027e685c	1066	}
okini3939	1:e3b2027e685c	1067
okini3939	1:e3b2027e685c	1068	uint8_t Tx16Request::getFrameData(uint8_t pos) {
okini3939	1:e3b2027e685c	1069
okini3939	1:e3b2027e685c	1070	if (pos == 0) {
okini3939	1:e3b2027e685c	1071	return (_addr16 >> 8) & 0xff;
okini3939	1:e3b2027e685c	1072	} else if (pos == 1) {
okini3939	1:e3b2027e685c	1073	return _addr16 & 0xff;
okini3939	1:e3b2027e685c	1074	} else if (pos == 2) {
okini3939	1:e3b2027e685c	1075	return _option;
okini3939	1:e3b2027e685c	1076	} else {
okini3939	1:e3b2027e685c	1077	return getPayload()[pos - TX_16_API_LENGTH];
okini3939	1:e3b2027e685c	1078	}
okini3939	1:e3b2027e685c	1079	}
okini3939	1:e3b2027e685c	1080
okini3939	1:e3b2027e685c	1081	uint8_t Tx16Request::getFrameDataLength() {
okini3939	1:e3b2027e685c	1082	return TX_16_API_LENGTH + getPayloadLength();
okini3939	1:e3b2027e685c	1083	}
okini3939	1:e3b2027e685c	1084
okini3939	1:e3b2027e685c	1085	uint16_t Tx16Request::getAddress16() {
okini3939	1:e3b2027e685c	1086	return _addr16;
okini3939	1:e3b2027e685c	1087	}
okini3939	1:e3b2027e685c	1088
okini3939	1:e3b2027e685c	1089	void Tx16Request::setAddress16(uint16_t addr16) {
okini3939	1:e3b2027e685c	1090	_addr16 = addr16;
okini3939	1:e3b2027e685c	1091	}
okini3939	1:e3b2027e685c	1092
okini3939	1:e3b2027e685c	1093	uint8_t Tx16Request::getOption() {
okini3939	1:e3b2027e685c	1094	return _option;
okini3939	1:e3b2027e685c	1095	}
okini3939	1:e3b2027e685c	1096
okini3939	1:e3b2027e685c	1097	void Tx16Request::setOption(uint8_t option) {
okini3939	1:e3b2027e685c	1098	_option = option;
okini3939	1:e3b2027e685c	1099	}
okini3939	1:e3b2027e685c	1100
okini3939	1:e3b2027e685c	1101	Tx64Request::Tx64Request() : PayloadRequest(TX_64_REQUEST, DEFAULT_FRAME_ID, NULL, 0) {
okini3939	1:e3b2027e685c	1102
okini3939	1:e3b2027e685c	1103	}
okini3939	1:e3b2027e685c	1104
okini3939	1:e3b2027e685c	1105	Tx64Request::Tx64Request(XBeeAddress64 &addr64, uint8_t option, uint8_t *data, uint8_t dataLength, uint8_t frameId) : PayloadRequest(TX_64_REQUEST, frameId, data, dataLength) {
okini3939	1:e3b2027e685c	1106	_addr64 = addr64;
okini3939	1:e3b2027e685c	1107	_option = option;
okini3939	1:e3b2027e685c	1108	}
okini3939	1:e3b2027e685c	1109
okini3939	1:e3b2027e685c	1110	Tx64Request::Tx64Request(XBeeAddress64 &addr64, uint8_t *data, uint8_t dataLength) : PayloadRequest(TX_64_REQUEST, DEFAULT_FRAME_ID, data, dataLength) {
okini3939	1:e3b2027e685c	1111	_addr64 = addr64;
okini3939	1:e3b2027e685c	1112	_option = ACK_OPTION;
okini3939	1:e3b2027e685c	1113	}
okini3939	1:e3b2027e685c	1114
okini3939	1:e3b2027e685c	1115	uint8_t Tx64Request::getFrameData(uint8_t pos) {
okini3939	1:e3b2027e685c	1116
okini3939	1:e3b2027e685c	1117	if (pos == 0) {
okini3939	1:e3b2027e685c	1118	return (_addr64.getMsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	1119	} else if (pos == 1) {
okini3939	1:e3b2027e685c	1120	return (_addr64.getMsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	1121	} else if (pos == 2) {
okini3939	1:e3b2027e685c	1122	return (_addr64.getMsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	1123	} else if (pos == 3) {
okini3939	1:e3b2027e685c	1124	return _addr64.getMsb() & 0xff;
okini3939	1:e3b2027e685c	1125	} else if (pos == 4) {
okini3939	1:e3b2027e685c	1126	return (_addr64.getLsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	1127	} else if (pos == 5) {
okini3939	1:e3b2027e685c	1128	return (_addr64.getLsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	1129	} else if (pos == 6) {
okini3939	1:e3b2027e685c	1130	return(_addr64.getLsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	1131	} else if (pos == 7) {
okini3939	1:e3b2027e685c	1132	return _addr64.getLsb() & 0xff;
okini3939	1:e3b2027e685c	1133	} else if (pos == 8) {
okini3939	1:e3b2027e685c	1134	return _option;
okini3939	1:e3b2027e685c	1135	} else {
okini3939	1:e3b2027e685c	1136	return getPayload()[pos - TX_64_API_LENGTH];
okini3939	1:e3b2027e685c	1137	}
okini3939	1:e3b2027e685c	1138	}
okini3939	1:e3b2027e685c	1139
okini3939	1:e3b2027e685c	1140	uint8_t Tx64Request::getFrameDataLength() {
okini3939	1:e3b2027e685c	1141	return TX_64_API_LENGTH + getPayloadLength();
okini3939	1:e3b2027e685c	1142	}
okini3939	1:e3b2027e685c	1143
okini3939	1:e3b2027e685c	1144	XBeeAddress64& Tx64Request::getAddress64() {
okini3939	1:e3b2027e685c	1145	return _addr64;
okini3939	1:e3b2027e685c	1146	}
okini3939	1:e3b2027e685c	1147
okini3939	1:e3b2027e685c	1148	void Tx64Request::setAddress64(XBeeAddress64& addr64) {
okini3939	1:e3b2027e685c	1149	_addr64 = addr64;
okini3939	1:e3b2027e685c	1150	}
okini3939	1:e3b2027e685c	1151
okini3939	1:e3b2027e685c	1152	uint8_t Tx64Request::getOption() {
okini3939	1:e3b2027e685c	1153	return _option;
okini3939	1:e3b2027e685c	1154	}
okini3939	1:e3b2027e685c	1155
okini3939	1:e3b2027e685c	1156	void Tx64Request::setOption(uint8_t option) {
okini3939	1:e3b2027e685c	1157	_option = option;
okini3939	1:e3b2027e685c	1158	}
okini3939	1:e3b2027e685c	1159
okini3939	1:e3b2027e685c	1160	#endif
okini3939	1:e3b2027e685c	1161
okini3939	1:e3b2027e685c	1162	AtCommandRequest::AtCommandRequest() : XBeeRequest(AT_COMMAND_REQUEST, DEFAULT_FRAME_ID) {
okini3939	1:e3b2027e685c	1163	_command = NULL;
okini3939	1:e3b2027e685c	1164	clearCommandValue();
okini3939	1:e3b2027e685c	1165	}
okini3939	1:e3b2027e685c	1166
okini3939	1:e3b2027e685c	1167	AtCommandRequest::AtCommandRequest(uint8_t command, uint8_t commandValue, uint8_t commandValueLength) : XBeeRequest(AT_COMMAND_REQUEST, DEFAULT_FRAME_ID) {
okini3939	1:e3b2027e685c	1168	_command = command;
okini3939	1:e3b2027e685c	1169	_commandValue = commandValue;
okini3939	1:e3b2027e685c	1170	_commandValueLength = commandValueLength;
okini3939	1:e3b2027e685c	1171	}
okini3939	1:e3b2027e685c	1172
okini3939	1:e3b2027e685c	1173	AtCommandRequest::AtCommandRequest(uint8_t *command) : XBeeRequest(AT_COMMAND_REQUEST, DEFAULT_FRAME_ID) {
okini3939	1:e3b2027e685c	1174	_command = command;
okini3939	1:e3b2027e685c	1175	clearCommandValue();
okini3939	1:e3b2027e685c	1176	}
okini3939	1:e3b2027e685c	1177
okini3939	1:e3b2027e685c	1178	uint8_t* AtCommandRequest::getCommand() {
okini3939	1:e3b2027e685c	1179	return _command;
okini3939	1:e3b2027e685c	1180	}
okini3939	1:e3b2027e685c	1181
okini3939	1:e3b2027e685c	1182	uint8_t* AtCommandRequest::getCommandValue() {
okini3939	1:e3b2027e685c	1183	return _commandValue;
okini3939	1:e3b2027e685c	1184	}
okini3939	1:e3b2027e685c	1185
okini3939	1:e3b2027e685c	1186	uint8_t AtCommandRequest::getCommandValueLength() {
okini3939	1:e3b2027e685c	1187	return _commandValueLength;
okini3939	1:e3b2027e685c	1188	}
okini3939	1:e3b2027e685c	1189
okini3939	1:e3b2027e685c	1190	void AtCommandRequest::setCommand(uint8_t* command) {
okini3939	1:e3b2027e685c	1191	_command = command;
okini3939	1:e3b2027e685c	1192	}
okini3939	1:e3b2027e685c	1193
okini3939	1:e3b2027e685c	1194	void AtCommandRequest::setCommandValue(uint8_t* value) {
okini3939	1:e3b2027e685c	1195	_commandValue = value;
okini3939	1:e3b2027e685c	1196	}
okini3939	1:e3b2027e685c	1197
okini3939	1:e3b2027e685c	1198	void AtCommandRequest::setCommandValueLength(uint8_t length) {
okini3939	1:e3b2027e685c	1199	_commandValueLength = length;
okini3939	1:e3b2027e685c	1200	}
okini3939	1:e3b2027e685c	1201
okini3939	1:e3b2027e685c	1202	uint8_t AtCommandRequest::getFrameData(uint8_t pos) {
okini3939	1:e3b2027e685c	1203
okini3939	1:e3b2027e685c	1204	if (pos == 0) {
okini3939	1:e3b2027e685c	1205	return _command[0];
okini3939	1:e3b2027e685c	1206	} else if (pos == 1) {
okini3939	1:e3b2027e685c	1207	return _command[1];
okini3939	1:e3b2027e685c	1208	} else {
okini3939	1:e3b2027e685c	1209	return _commandValue[pos - AT_COMMAND_API_LENGTH];
okini3939	1:e3b2027e685c	1210	}
okini3939	1:e3b2027e685c	1211	}
okini3939	1:e3b2027e685c	1212
okini3939	1:e3b2027e685c	1213	void AtCommandRequest::clearCommandValue() {
okini3939	1:e3b2027e685c	1214	_commandValue = NULL;
okini3939	1:e3b2027e685c	1215	_commandValueLength = 0;
okini3939	1:e3b2027e685c	1216	}
okini3939	1:e3b2027e685c	1217
okini3939	1:e3b2027e685c	1218	//void AtCommandRequest::reset() {
okini3939	1:e3b2027e685c	1219	// XBeeRequest::reset();
okini3939	1:e3b2027e685c	1220	//}
okini3939	1:e3b2027e685c	1221
okini3939	1:e3b2027e685c	1222	uint8_t AtCommandRequest::getFrameDataLength() {
okini3939	1:e3b2027e685c	1223	// command is 2 byte + length of value
okini3939	1:e3b2027e685c	1224	return AT_COMMAND_API_LENGTH + _commandValueLength;
okini3939	1:e3b2027e685c	1225	}
okini3939	1:e3b2027e685c	1226
okini3939	1:e3b2027e685c	1227	XBeeAddress64 RemoteAtCommandRequest::broadcastAddress64 = XBeeAddress64(0x0, BROADCAST_ADDRESS);
okini3939	1:e3b2027e685c	1228
okini3939	1:e3b2027e685c	1229	RemoteAtCommandRequest::RemoteAtCommandRequest() : AtCommandRequest(NULL, NULL, 0) {
okini3939	1:e3b2027e685c	1230	_remoteAddress16 = 0;
okini3939	1:e3b2027e685c	1231	_applyChanges = false;
okini3939	1:e3b2027e685c	1232	setApiId(REMOTE_AT_REQUEST);
okini3939	1:e3b2027e685c	1233	}
okini3939	1:e3b2027e685c	1234
okini3939	1:e3b2027e685c	1235	RemoteAtCommandRequest::RemoteAtCommandRequest(uint16_t remoteAddress16, uint8_t command, uint8_t commandValue, uint8_t commandValueLength) : AtCommandRequest(command, commandValue, commandValueLength) {
okini3939	1:e3b2027e685c	1236	_remoteAddress64 = broadcastAddress64;
okini3939	1:e3b2027e685c	1237	_remoteAddress16 = remoteAddress16;
okini3939	1:e3b2027e685c	1238	_applyChanges = true;
okini3939	1:e3b2027e685c	1239	setApiId(REMOTE_AT_REQUEST);
okini3939	1:e3b2027e685c	1240	}
okini3939	1:e3b2027e685c	1241
okini3939	1:e3b2027e685c	1242	RemoteAtCommandRequest::RemoteAtCommandRequest(uint16_t remoteAddress16, uint8_t *command) : AtCommandRequest(command, NULL, 0) {
okini3939	1:e3b2027e685c	1243	_remoteAddress64 = broadcastAddress64;
okini3939	1:e3b2027e685c	1244	_remoteAddress16 = remoteAddress16;
okini3939	1:e3b2027e685c	1245	_applyChanges = false;
okini3939	1:e3b2027e685c	1246	setApiId(REMOTE_AT_REQUEST);
okini3939	1:e3b2027e685c	1247	}
okini3939	1:e3b2027e685c	1248
okini3939	1:e3b2027e685c	1249	RemoteAtCommandRequest::RemoteAtCommandRequest(XBeeAddress64 &remoteAddress64, uint8_t command, uint8_t commandValue, uint8_t commandValueLength) : AtCommandRequest(command, commandValue, commandValueLength) {
okini3939	1:e3b2027e685c	1250	_remoteAddress64 = remoteAddress64;
okini3939	1:e3b2027e685c	1251	// don't worry.. works for series 1 too!
okini3939	1:e3b2027e685c	1252	_remoteAddress16 = ZB_BROADCAST_ADDRESS;
okini3939	1:e3b2027e685c	1253	_applyChanges = true;
okini3939	1:e3b2027e685c	1254	setApiId(REMOTE_AT_REQUEST);
okini3939	1:e3b2027e685c	1255	}
okini3939	1:e3b2027e685c	1256
okini3939	1:e3b2027e685c	1257	RemoteAtCommandRequest::RemoteAtCommandRequest(XBeeAddress64 &remoteAddress64, uint8_t *command) : AtCommandRequest(command, NULL, 0) {
okini3939	1:e3b2027e685c	1258	_remoteAddress64 = remoteAddress64;
okini3939	1:e3b2027e685c	1259	_remoteAddress16 = ZB_BROADCAST_ADDRESS;
okini3939	1:e3b2027e685c	1260	_applyChanges = false;
okini3939	1:e3b2027e685c	1261	setApiId(REMOTE_AT_REQUEST);
okini3939	1:e3b2027e685c	1262	}
okini3939	1:e3b2027e685c	1263
okini3939	1:e3b2027e685c	1264	uint16_t RemoteAtCommandRequest::getRemoteAddress16() {
okini3939	1:e3b2027e685c	1265	return _remoteAddress16;
okini3939	1:e3b2027e685c	1266	}
okini3939	1:e3b2027e685c	1267
okini3939	1:e3b2027e685c	1268	void RemoteAtCommandRequest::setRemoteAddress16(uint16_t remoteAddress16) {
okini3939	1:e3b2027e685c	1269	_remoteAddress16 = remoteAddress16;
okini3939	1:e3b2027e685c	1270	}
okini3939	1:e3b2027e685c	1271
okini3939	1:e3b2027e685c	1272	XBeeAddress64& RemoteAtCommandRequest::getRemoteAddress64() {
okini3939	1:e3b2027e685c	1273	return _remoteAddress64;
okini3939	1:e3b2027e685c	1274	}
okini3939	1:e3b2027e685c	1275
okini3939	1:e3b2027e685c	1276	void RemoteAtCommandRequest::setRemoteAddress64(XBeeAddress64 &remoteAddress64) {
okini3939	1:e3b2027e685c	1277	_remoteAddress64 = remoteAddress64;
okini3939	1:e3b2027e685c	1278	}
okini3939	1:e3b2027e685c	1279
okini3939	1:e3b2027e685c	1280	bool RemoteAtCommandRequest::getApplyChanges() {
okini3939	1:e3b2027e685c	1281	return _applyChanges;
okini3939	1:e3b2027e685c	1282	}
okini3939	1:e3b2027e685c	1283
okini3939	1:e3b2027e685c	1284	void RemoteAtCommandRequest::setApplyChanges(bool applyChanges) {
okini3939	1:e3b2027e685c	1285	_applyChanges = applyChanges;
okini3939	1:e3b2027e685c	1286	}
okini3939	1:e3b2027e685c	1287
okini3939	1:e3b2027e685c	1288
okini3939	1:e3b2027e685c	1289	uint8_t RemoteAtCommandRequest::getFrameData(uint8_t pos) {
okini3939	1:e3b2027e685c	1290	if (pos == 0) {
okini3939	1:e3b2027e685c	1291	return (_remoteAddress64.getMsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	1292	} else if (pos == 1) {
okini3939	1:e3b2027e685c	1293	return (_remoteAddress64.getMsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	1294	} else if (pos == 2) {
okini3939	1:e3b2027e685c	1295	return (_remoteAddress64.getMsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	1296	} else if (pos == 3) {
okini3939	1:e3b2027e685c	1297	return _remoteAddress64.getMsb() & 0xff;
okini3939	1:e3b2027e685c	1298	} else if (pos == 4) {
okini3939	1:e3b2027e685c	1299	return (_remoteAddress64.getLsb() >> 24) & 0xff;
okini3939	1:e3b2027e685c	1300	} else if (pos == 5) {
okini3939	1:e3b2027e685c	1301	return (_remoteAddress64.getLsb() >> 16) & 0xff;
okini3939	1:e3b2027e685c	1302	} else if (pos == 6) {
okini3939	1:e3b2027e685c	1303	return(_remoteAddress64.getLsb() >> 8) & 0xff;
okini3939	1:e3b2027e685c	1304	} else if (pos == 7) {
okini3939	1:e3b2027e685c	1305	return _remoteAddress64.getLsb() & 0xff;
okini3939	1:e3b2027e685c	1306	} else if (pos == 8) {
okini3939	1:e3b2027e685c	1307	return (_remoteAddress16 >> 8) & 0xff;
okini3939	1:e3b2027e685c	1308	} else if (pos == 9) {
okini3939	1:e3b2027e685c	1309	return _remoteAddress16 & 0xff;
okini3939	1:e3b2027e685c	1310	} else if (pos == 10) {
okini3939	1:e3b2027e685c	1311	return _applyChanges ? 2: 0;
okini3939	1:e3b2027e685c	1312	} else if (pos == 11) {
okini3939	1:e3b2027e685c	1313	return getCommand()[0];
okini3939	1:e3b2027e685c	1314	} else if (pos == 12) {
okini3939	1:e3b2027e685c	1315	return getCommand()[1];
okini3939	1:e3b2027e685c	1316	} else {
okini3939	1:e3b2027e685c	1317	return getCommandValue()[pos - REMOTE_AT_COMMAND_API_LENGTH];
okini3939	1:e3b2027e685c	1318	}
okini3939	1:e3b2027e685c	1319	}
okini3939	1:e3b2027e685c	1320
okini3939	1:e3b2027e685c	1321	uint8_t RemoteAtCommandRequest::getFrameDataLength() {
okini3939	1:e3b2027e685c	1322	return REMOTE_AT_COMMAND_API_LENGTH + getCommandValueLength();
okini3939	1:e3b2027e685c	1323	}
okini3939	1:e3b2027e685c	1324
okini3939	1:e3b2027e685c	1325
okini3939	1:e3b2027e685c	1326	// TODO
okini3939	1:e3b2027e685c	1327	//GenericRequest::GenericRequest(uint8_t* frame, uint8_t len, uint8_t apiId): XBeeRequest(apiId, *(frame), len) {
okini3939	1:e3b2027e685c	1328	// _frame = frame;
okini3939	1:e3b2027e685c	1329	//}
okini3939	1:e3b2027e685c	1330
okini3939	1:e3b2027e685c	1331	void XBee::send(XBeeRequest &request) {
okini3939	1:e3b2027e685c	1332	// the new new deal
okini3939	1:e3b2027e685c	1333
okini3939	1:e3b2027e685c	1334	sendByte(START_BYTE, false);
okini3939	1:e3b2027e685c	1335
okini3939	1:e3b2027e685c	1336	// send length
okini3939	1:e3b2027e685c	1337	uint8_t msbLen = ((request.getFrameDataLength() + 2) >> 8) & 0xff;
okini3939	1:e3b2027e685c	1338	uint8_t lsbLen = (request.getFrameDataLength() + 2) & 0xff;
okini3939	1:e3b2027e685c	1339
okini3939	1:e3b2027e685c	1340	sendByte(msbLen, true);
okini3939	1:e3b2027e685c	1341	sendByte(lsbLen, true);
okini3939	1:e3b2027e685c	1342
okini3939	1:e3b2027e685c	1343	// api id
okini3939	1:e3b2027e685c	1344	sendByte(request.getApiId(), true);
okini3939	1:e3b2027e685c	1345	sendByte(request.getFrameId(), true);
okini3939	1:e3b2027e685c	1346
okini3939	1:e3b2027e685c	1347	uint8_t checksum = 0;
okini3939	1:e3b2027e685c	1348
okini3939	1:e3b2027e685c	1349	// compute checksum, start at api id
okini3939	1:e3b2027e685c	1350	checksum+= request.getApiId();
okini3939	1:e3b2027e685c	1351	checksum+= request.getFrameId();
okini3939	1:e3b2027e685c	1352
okini3939	1:e3b2027e685c	1353	//std::cout << "frame length is " << static_cast<unsigned int>(request.getFrameDataLength()) << std::endl;
okini3939	1:e3b2027e685c	1354
okini3939	1:e3b2027e685c	1355	for (int i = 0; i < request.getFrameDataLength(); i++) {
okini3939	1:e3b2027e685c	1356	// std::cout << "sending byte [" << static_cast<unsigned int>(i) << "] " << std::endl;
okini3939	1:e3b2027e685c	1357	sendByte(request.getFrameData(i), true);
okini3939	1:e3b2027e685c	1358	checksum+= request.getFrameData(i);
okini3939	1:e3b2027e685c	1359	}
okini3939	1:e3b2027e685c	1360
okini3939	1:e3b2027e685c	1361	// perform 2s complement
okini3939	1:e3b2027e685c	1362	checksum = 0xff - checksum;
okini3939	1:e3b2027e685c	1363
okini3939	1:e3b2027e685c	1364	// std::cout << "checksum is " << static_cast<unsigned int>(checksum) << std::endl;
okini3939	1:e3b2027e685c	1365
okini3939	1:e3b2027e685c	1366	// send checksum
okini3939	1:e3b2027e685c	1367	sendByte(checksum, true);
okini3939	1:e3b2027e685c	1368	/*
okini3939	1:e3b2027e685c	1369	// send packet
okini3939	1:e3b2027e685c	1370	Serial.flush();
okini3939	1:e3b2027e685c	1371	*/
okini3939	3:8573b122fa84	1372	DBG("\r\n");
okini3939	1:e3b2027e685c	1373	}
okini3939	1:e3b2027e685c	1374
okini3939	1:e3b2027e685c	1375	void XBee::sendByte(uint8_t b, bool escape) {
okini3939	1:e3b2027e685c	1376
okini3939	1:e3b2027e685c	1377	if (escape && (b == START_BYTE \|\| b == ESCAPE \|\| b == XON \|\| b == XOFF)) {
okini3939	1:e3b2027e685c	1378	// std::cout << "escaping byte [" << toHexString(b) << "] " << std::endl;
okini3939	3:8573b122fa84	1379	if (_cts) while (_cts->read() != 0);
okini3939	1:e3b2027e685c	1380	_xbee.putc(ESCAPE);
okini3939	3:8573b122fa84	1381	if (_cts) while (_cts->read() != 0);
okini3939	1:e3b2027e685c	1382	_xbee.putc(b ^ 0x20);
okini3939	1:e3b2027e685c	1383	} else {
okini3939	3:8573b122fa84	1384	if (_cts) while (_cts->read() != 0);
okini3939	1:e3b2027e685c	1385	_xbee.putc(b);
okini3939	1:e3b2027e685c	1386	}
okini3939	3:8573b122fa84	1387	DBG("%02x ", b);
okini3939	1:e3b2027e685c	1388	}
okini3939	1:e3b2027e685c	1389

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	04 Jan 2014
Imports:	9
Forks:	0
Commits:	11
Dependents:	1
Dependencies:	0
Followers:	3

XBee.cpp@3:8573b122fa84, 2012-03-08 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning