Megabot C++ file for MegaBot library

MegaBot.cpp

// Megabot control library
// David Cotterill-Drew @2013 RoboTonics

#include <Arduino.h>
#include <MegaBot.h>

MegaBot::MegaBot(int R0, int R1, int L0, int L1, int EN0, int EN1)
{

int _R0=R0;
int _R1=R1;
int _EN0=EN0;
int _EN1=EN1;
int _L1=L1;
int _L0=L0;


pinMode(_R0,OUTPUT);
pinMode(_R1,OUTPUT);
pinMode(_EN0,OUTPUT);
pinMode(_EN1,OUTPUT);
pinMode(_L0,OUTPUT);
pinMode(_L1,OUTPUT);

} 
void MegaBot::fwd(void)
{
	digitalWrite(R0,HIGH);
	digitalWrite(R1,LOW);
	digitalWrite(EN0,HIGH);
	digitalWrite(EN1,HIGH);
	digitalWrite(L0,HIGH);
	digitalWrite(L1,LOW);
}
void MegaBot::bck(void)
{
	digitalWrite(R0,LOW);
	digitalWrite(R1,HIGH);
	digitalWrite(EN0,HIGH);
	digitalWrite(EN1,HIGH);
	digitalWrite(L0,LOW);
	digitalWrite(L1,LOW);

}

void MegaBot::rgt(void)
{
	digitalWrite(R0,HIGH);
	digitalWrite(R1,HIGH);
	digitalWrite(EN0,HIGH);
	digitalWrite(EN1,HIGH);
	digitalWrite(L0,HIGH);
	digitalWrite(L1,HIGH);

}

void MegaBot::lft(void)
{
	digitalWrite(R0,LOW);
	digitalWrite(R1,LOW);
	digitalWrite(EN0,HIGH);
	digitalWrite(EN1,HIGH);
	digitalWrite(L0,LOW);
	digitalWrite(L1,LOW);
}
void MegaBot::stp(void)
 {
 	digitalWrite(EN0,LOW);
 	digitalWrite(EN1,LOW);
 }
// end of routines