servoMotor.cpp

/******************************************************************************
*                                                                             *
*   Program : FileLogger                                                      *
*                                                                             *
*   FILE : servoMotor.cpp                                                     *
*                                                                             *
*   Date : 28 / 05 / 2021                                                     *
*                                                                             *
*   Programmers : Team Software "TORQ"                                        *
*                                                                             *
******************************************************************************/

#include "servoMotor.h"

ServoMotor::ServoMotor(byte m_pin)
{
    pin = m_pin;
    pos = 92;
}

void ServoMotor::init()
{
    servo.attach(pin);
}

void ServoMotor::rotate_left(int r_angle)
{
   servo.write(pos + r_angle);
}

void ServoMotor::rotate_right(int r_angle)
{
    servo.write(pos - r_angle);
}

void ServoMotor::reset()
{
    pos = 90;
    servo.write(pos);
}