#include <wiringPi.h>

#define M1_IN1 8  // PIN 3
#define M1_IN2 7  // PIN 7
#define M2_IN1 9  // PIN 5
#define M2_IN2 15 // PIN 8

// OUT1 -> OUT2
void forward(int in1, int in2) {
	digitalWrite(in1, LOW);
	digitalWrite(in2, HIGH);
}

// OUT2 -> OUT1
void reverse(int in1, int in2) {
	digitalWrite(in1, HIGH);
	digitalWrite(in2, LOW);
}

void brake(int in1, int in2) {
	digitalWrite(in1, LOW);
	digitalWrite(in2, LOW);
}

void off(int in1, int in2) {
	digitalWrite(in1, HIGH);
	digitalWrite(in2, HIGH);
}

int main(void) {
	wiringPiSetup();

	pinMode(M1_IN1, OUTPUT);
	pinMode(M1_IN2, OUTPUT);
	pinMode(M2_IN1, OUTPUT);
	pinMode(M2_IN2, OUTPUT);

	// FORWARD
	forward(M1_IN1, M1_IN2);
	forward(M2_IN1, M1_IN2);
	delay(1000);
	
	// PARK
	brake(M1_IN1, M1_IN2);
	brake(M2_IN1, M2_IN2);
	delay(1000);

	//REVERSE
	reverse(M1_IN1, M1_IN2);
	reverse(M2_IN1, M2_IN2);
	delay(1000);

	// OFF
	off(M1_IN1, M1_IN2);
	off(M2_IN1, M2_IN2);
	delay(1000);

	return 0;
}