|  | @@ -0,0 +1,95 @@
 | 
	
		
			
			|  | 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 two TT moto of DC 3v-12v.
 | 
	
		
			
			|  | 24 | + *
 | 
	
		
			
			|  | 25 | + * Information about the makercup obtained from:
 | 
	
		
			
			|  | 26 | + * https://medium.com/maker-cup
 | 
	
		
			
			|  | 27 | + */
 | 
	
		
			
			|  | 28 | +
 | 
	
		
			
			|  | 29 | +
 | 
	
		
			
			|  | 30 | +// --------------------------------------------------------------------------------------
 | 
	
		
			
			|  | 31 | +
 | 
	
		
			
			|  | 32 | +#include "TwoMotoCar.h"
 | 
	
		
			
			|  | 33 | +
 | 
	
		
			
			|  | 34 | +// --------------------------------------------------------------------------------------
 | 
	
		
			
			|  | 35 | +
 | 
	
		
			
			|  | 36 | +TwoMotoCar::TwoMotoCar(byte MotoPinL1, byte MotoPinL2, byte MotoPinR1, byte MotoPinR2) :
 | 
	
		
			
			|  | 37 | +    _MotoPinL1(MotoPinL1), _MotoPinL2(MotoPinL2), _MotoPinR1(MotoPinR1), _MotoPinR2(MotoPinR2)
 | 
	
		
			
			|  | 38 | +{
 | 
	
		
			
			|  | 39 | +
 | 
	
		
			
			|  | 40 | +}
 | 
	
		
			
			|  | 41 | +
 | 
	
		
			
			|  | 42 | +TwoMotoCar::~TwoMotoCar()
 | 
	
		
			
			|  | 43 | +{
 | 
	
		
			
			|  | 44 | +
 | 
	
		
			
			|  | 45 | +}
 | 
	
		
			
			|  | 46 | +
 | 
	
		
			
			|  | 47 | +// --------------------------------------------------------------------------------------
 | 
	
		
			
			|  | 48 | +
 | 
	
		
			
			|  | 49 | +void TwoMotoCar::init()
 | 
	
		
			
			|  | 50 | +{
 | 
	
		
			
			|  | 51 | +    pinMode(_MotoPinL1, OUTPUT);
 | 
	
		
			
			|  | 52 | +    pinMode(_MotoPinL2, OUTPUT);
 | 
	
		
			
			|  | 53 | +    pinMode(_MotoPinR1, OUTPUT);
 | 
	
		
			
			|  | 54 | +    pinMode(_MotoPinR2, OUTPUT);
 | 
	
		
			
			|  | 55 | +}
 | 
	
		
			
			|  | 56 | +
 | 
	
		
			
			|  | 57 | +void TwoMotoCar::forward(void)
 | 
	
		
			
			|  | 58 | +{
 | 
	
		
			
			|  | 59 | +  digitalWrite(_MotoPinL1,HIGH);
 | 
	
		
			
			|  | 60 | +  digitalWrite(_MotoPinL2,LOW);
 | 
	
		
			
			|  | 61 | +  digitalWrite(_MotoPinR1,HIGH);
 | 
	
		
			
			|  | 62 | +  digitalWrite(_MotoPinR2,LOW);
 | 
	
		
			
			|  | 63 | +}
 | 
	
		
			
			|  | 64 | +
 | 
	
		
			
			|  | 65 | +void TwoMotoCar::right(void)
 | 
	
		
			
			|  | 66 | +{
 | 
	
		
			
			|  | 67 | +  digitalWrite(_MotoPinL1,HIGH);
 | 
	
		
			
			|  | 68 | +  digitalWrite(_MotoPinL2,LOW);
 | 
	
		
			
			|  | 69 | +  digitalWrite(_MotoPinR1,LOW);
 | 
	
		
			
			|  | 70 | +  digitalWrite(_MotoPinR2,LOW);
 | 
	
		
			
			|  | 71 | +}
 | 
	
		
			
			|  | 72 | +
 | 
	
		
			
			|  | 73 | +void TwoMotoCar::left(void)
 | 
	
		
			
			|  | 74 | +{
 | 
	
		
			
			|  | 75 | +  digitalWrite(_MotoPinL1,LOW);
 | 
	
		
			
			|  | 76 | +  digitalWrite(_MotoPinL2,LOW);
 | 
	
		
			
			|  | 77 | +  digitalWrite(_MotoPinR1,HIGH);
 | 
	
		
			
			|  | 78 | +  digitalWrite(_MotoPinR2,LOW);
 | 
	
		
			
			|  | 79 | +}
 | 
	
		
			
			|  | 80 | +
 | 
	
		
			
			|  | 81 | +void TwoMotoCar::backward(void)
 | 
	
		
			
			|  | 82 | +{
 | 
	
		
			
			|  | 83 | +  digitalWrite(_MotoPinL1,LOW);
 | 
	
		
			
			|  | 84 | +  digitalWrite(_MotoPinL2,HIGH);
 | 
	
		
			
			|  | 85 | +  digitalWrite(_MotoPinR1,LOW);
 | 
	
		
			
			|  | 86 | +  digitalWrite(_MotoPinR2,HIGH);
 | 
	
		
			
			|  | 87 | +}
 | 
	
		
			
			|  | 88 | +
 | 
	
		
			
			|  | 89 | +void TwoMotoCar::stop(void)
 | 
	
		
			
			|  | 90 | +{
 | 
	
		
			
			|  | 91 | +  digitalWrite(_MotoPinL1,LOW);
 | 
	
		
			
			|  | 92 | +  digitalWrite(_MotoPinL2,LOW);
 | 
	
		
			
			|  | 93 | +  digitalWrite(_MotoPinR1,LOW);
 | 
	
		
			
			|  | 94 | +  digitalWrite(_MotoPinR2,LOW);
 | 
	
		
			
			|  | 95 | +}
 |