Diff: src/Target.cpp

Revision:

1:e1c5259b7d9a

Child:

2:019d8848cf7e

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/Target.cpp	Mon Apr 10 15:02:24 2017 -0400
@@ -0,0 +1,32 @@
+#include "Target.hpp"
+
+RealXbeeTransmitter xbee_transmitter;
+
+Target::Target(int address_msb, int address_lsb, int target_number)
+{
+    get_address_for_xbee(address_msb, address_lsb);
+    this->target_number = target_number;
+}
+
+void Target::rise(int mode, int timeout)
+{
+    toPc("Rising target %i!", target_number);
+    vector<uint8_t> message;
+    message.push_back(target_number);
+    message.push_back(mode);
+    message.push_back((timeout >> 8) & 0xFF);
+    message.push_back(timeout && 0xFF);
+    xbee_transmitter.transmit(message, addr_table);
+}
+
+void Target::get_address_for_xbee(int address_msb, int address_lsb)
+{
+    addr_table[0] = address_msb >> 24;
+    addr_table[1] = (address_msb >> 16) & 0xFF;
+    addr_table[2] = (address_msb >> 8) & 0xFF;
+    addr_table[3] = (address_msb) & 0xFF;
+    addr_table[4] = address_lsb >> 24;
+    addr_table[5] = (address_lsb >> 16) & 0xFF;
+    addr_table[6] = (address_lsb >> 8) & 0xFF;
+    addr_table[7] = (address_lsb) & 0xFF;
+}
\ No newline at end of file