|  | @@ -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 | +}
 |