X-Git-Url: http://git.droids-corp.org/?p=protos%2Fxbee-avr.git;a=blobdiff_plain;f=rc_proto.c;h=4ced1232883f73e565f5aea04b8b25e8f2eb6799;hp=442eb909347be1c7666cfafb22a14ef6afde03e1;hb=0373c0e13f4a81426ee5084c0c1ee148bc6b935a;hpb=8e219fe02de38683879295e5bd42b67ce9d5b849

diff --git a/rc_proto.c b/rc_proto.c
index 442eb90..4ced123 100644
--- a/rc_proto.c
+++ b/rc_proto.c
@@ -243,3 +243,61 @@ int8_t buf2servo(uint8_t *buf, uint8_t len)
 	return 0;
 }
 #endif
+
+int rc_proto_rx(struct xbee_recv_hdr *recvframe, unsigned len)
+{
+	unsigned int datalen;
+	struct rc_proto_hdr *rch = (struct rc_proto_hdr *) &recvframe->data;
+
+	if (len <  sizeof(*recvframe))
+		return -1;
+
+	datalen = len - sizeof(*recvframe);
+	if (datalen < sizeof(struct rc_proto_hdr))
+		return -1;
+
+	switch (rch->type) {
+#if 0
+		case RC_PROTO_TYPE_CHANNEL: {
+			struct rc_proto_channel *rcc =
+				(struct rc_proto_channel *) recvframe->data;
+			int16_t val;
+			if (datalen != sizeof(struct rc_proto_channel))
+				return -1;
+			val = ntohs(rcc->axis[0]);
+			val >>= 6;
+			val += 512;
+			spi_servo_set(0, val);
+			break;
+		}
+#endif
+		case RC_PROTO_POWER_PROBE: {
+			struct rc_proto_power_probe *rcpb =
+				(struct rc_proto_power_probe *) recvframe->data;
+
+			if (datalen != sizeof(*rcpb))
+				return -1;
+
+			if (rcpb->power_level >= MAX_POWER_LEVEL)
+				return -1;
+
+			//rc_proto_rx_range(rcpb->power_level);
+
+			break;
+		}
+
+		case RC_PROTO_HELLO: {
+			struct rc_proto_hello *rch =
+				(struct rc_proto_hello *) recvframe->data;
+
+			NOTICE(E_USER_XBEE, "recv hello len=%d",
+				rch->datalen);
+			/* XXX stats */
+			break;
+		}
+		default:
+			return -1;
+	}
+
+	return 0;
+}