Servo.ino

#include "./Servo.h"


Servo_t servo;

void SRV_Init() {
	servo.position = 0;
	servo.setPosition = 0;

	// servo.servo.attach(PIN_SRV);
	SRV_Attach();
	SRV_Run();

	// Serial.println(F("SRV init done"));
	Serial.println(F("SRV init done"));
}

void SRV_SetPosition(uint8_t pos) {
	servo.setPosition = pos;
}

uint8_t SRV_GetPosition() {
	return servo.position;
}


void SRV_Run() {
	servo.servo.write(servo.setPosition);
	servo.position = servo.setPosition;
}

void SRV_Detach() {
	servo.servo.detach();
}
void SRV_Attach() {
	servo.servo.attach(PIN_SRV);
	delay(5000);
}