using namespace std;
#include <iostream>
#include <math.h>
#include <time.h>
#include <stdio.h>
#include "servos.h"
#include "settings.h"

Servos::Servos(IO *oIO_ptr) {
	oIO = oIO_ptr;
}


Servos::~Servos() {
}

bool Servos::Set(int num, int pos) {
	// :: sets the desired motor speed ::
	oIO->SetServo(num, pos);
}


void Servos::Demo() {
/*	// :: runs a short demo to show that the Servos work ::

	char input[5];

	cout << "Press enter to start" << endl;
	gets(input);
	cout << "Go to Min" << endl;
	Set(SERVO_ARM, 0);

	cout << "Press enter for next stage" << endl;
	gets(input);
	cout << "Go to Max" << endl;
	Set(SERVO_ARM, 0x7f);

	cout << "Press enter for next stage" << endl;
	gets(input);
	cout << "Go Midway" << endl;
	Set(SERVO_ARM, (0x7f/2));

	cout << "Demo Complete" << endl;
*/
}