|
@@ -0,0 +1,80 @@
|
|
1
|
+/*
|
|
2
|
+Copyright (C) 2016 Wesley Tsai (wesleyboy42@gmail.com)
|
|
3
|
+
|
|
4
|
+Permission is hereby granted, free of charge, to any person obtaining a copy of
|
|
5
|
+this software and associated documentation files (the "Software"), to deal in
|
|
6
|
+the Software without restriction, including without limitation the rights to
|
|
7
|
+use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
|
|
8
|
+the Software, and to permit persons to whom the Software is furnished to do so,
|
|
9
|
+subject to the following conditions:
|
|
10
|
+
|
|
11
|
+The above copyright notice and this permission notice shall be included in all
|
|
12
|
+copies or substantial portions of the Software.
|
|
13
|
+
|
|
14
|
+THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
15
|
+IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
|
|
16
|
+FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
|
|
17
|
+COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
|
|
18
|
+IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
19
|
+CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
20
|
+*/
|
|
21
|
+
|
|
22
|
+/*
|
|
23
|
+ * Library for controlling robot via I2C.
|
|
24
|
+ *
|
|
25
|
+ * Information about the makercup obtained from:
|
|
26
|
+ * https://medium.com/maker-cup
|
|
27
|
+ */
|
|
28
|
+
|
|
29
|
+
|
|
30
|
+// --------------------------------------------------------------------------------------
|
|
31
|
+
|
|
32
|
+#include "I2CRobot.h"
|
|
33
|
+#include <Wire.h>
|
|
34
|
+
|
|
35
|
+// --------------------------------------------------------------------------------------
|
|
36
|
+
|
|
37
|
+I2CRobot::I2CRobot(byte ID):_ID(ID)
|
|
38
|
+{
|
|
39
|
+
|
|
40
|
+}
|
|
41
|
+
|
|
42
|
+I2CRobot::~I2CRobot()
|
|
43
|
+{
|
|
44
|
+
|
|
45
|
+}
|
|
46
|
+
|
|
47
|
+// --------------------------------------------------------------------------------------
|
|
48
|
+
|
|
49
|
+void I2CRobot::init()
|
|
50
|
+{
|
|
51
|
+ Wire.begin();
|
|
52
|
+}
|
|
53
|
+
|
|
54
|
+void I2CRobot::hello(void)
|
|
55
|
+{
|
|
56
|
+ Wire.beginTransmission(_ID);
|
|
57
|
+ Wire.write(_hello);
|
|
58
|
+ Wire.endTransmission();
|
|
59
|
+}
|
|
60
|
+
|
|
61
|
+void I2CRobot::order(void)
|
|
62
|
+{
|
|
63
|
+ Wire.beginTransmission(_ID);
|
|
64
|
+ Wire.write(_order);
|
|
65
|
+ Wire.endTransmission();
|
|
66
|
+}
|
|
67
|
+
|
|
68
|
+void I2CRobot::check(void)
|
|
69
|
+{
|
|
70
|
+ Wire.beginTransmission(_ID);
|
|
71
|
+ Wire.write(_check);
|
|
72
|
+ Wire.endTransmission();
|
|
73
|
+}
|
|
74
|
+
|
|
75
|
+void I2CRobot::custom(byte custom)
|
|
76
|
+{
|
|
77
|
+ Wire.beginTransmission(_ID);
|
|
78
|
+ Wire.write(custom);
|
|
79
|
+ Wire.endTransmission();
|
|
80
|
+}
|