/*
 * RouterSetup.cpp
 *
 *  Created on: 25.01.2022
 *      Author: FSmilari
 */

#include "RouterSetup.h"

/******************
 ** Public methods
 *****************/
float RouterSetup::getSpeed() const {
	return speed;
}

void RouterSetup::setSpeed(float speed) {
	this->speed = speed;
}

float RouterSetup::getAcceleration() const {
	return accelleration;
}

void RouterSetup::setAcceleration(float accelleration) {
	this->accelleration = accelleration;
}

uint8_t RouterSetup::getEncoderSpeedFast() const {
	return encoderSpeedFast;
}

void RouterSetup::setEncoderSpeedFast(uint8_t encoderSpeedFast) {
	this->encoderSpeedFast = encoderSpeedFast;
}

uint8_t RouterSetup::getEncoderSpeedSlow() const {
	return encoderSpeedSlow;
}

void RouterSetup::setEncoderSpeedSlow(uint8_t encoderSpeedSlow) {
	this->encoderSpeedSlow = encoderSpeedSlow;
}

float RouterSetup::getLevelHeightDiving() const {
	return levelHeightDiving;
}

void RouterSetup::setLevelHeightDiving(float levelHeightDiving) {
	this->levelHeightDiving = levelHeightDiving;
}

float RouterSetup::getPitch() const {
	return pitch;
}

void RouterSetup::setPitch(float pitch) {
	this->pitch = pitch;
}

uint16_t RouterSetup::getStepsPerRev() const {
	return stepsPerRev;
}

void RouterSetup::setStepsPerRev(uint16_t stepsPerRev) {
	this->stepsPerRev = stepsPerRev;
}

float RouterSetup::getToolLenghtSensorHeight() const {
	return toolLenghtSensorHeight;
}

void RouterSetup::setToolLenghtSensorHeight(float toolLenghtSensorHeight) {
	this->toolLenghtSensorHeight = toolLenghtSensorHeight;
}

bool RouterSetup::isToolChangOnPowerOn() const {
	return toolChangeOnPowerOn;
}

void RouterSetup::setToolChangOnPowerOn(bool toolChangOnPowerOn) {
	this->toolChangeOnPowerOn = toolChangOnPowerOn;
}


void RouterSetup::clear() {
	speed = 0;
	accelleration = 0;
	stepsPerRev = 0;
	pitch = 0;
	toolLenghtSensorHeight = 0;
	encoderSpeedSlow = 0;
	encoderSpeedFast = 0;
	levelHeightDiving = 0;
	toolChangeOnPowerOn = true;
}


/**
 *  Reads the RouterSetup from EEPROM
 */
void RouterSetup::readFromEEPROM() {
	clear();
	eeprom.begin(ROUTER_NAMESPACE, false);
	setSpeed(eeprom.getFloat(SPEED, 1.0));
	setAcceleration(eeprom.getFloat(ACCELERATION, 1.0));
	setStepsPerRev(eeprom.getUInt(STEPSPERREV, 1600));
	setPitch(eeprom.getInt(PITCH, 3.0));
	setToolLenghtSensorHeight(eeprom.getFloat(TOOLLENGHTSNHT, 10.0));
	setEncoderSpeedSlow(eeprom.getInt(ENCSPEEDSLOW, 1));
	setEncoderSpeedFast(eeprom.getInt(ENCSPEEDFAST, 20));
	setLevelHeightDiving(eeprom.getFloat(LVLHEIGHTDIVE, 3.0));
	setToolChangOnPowerOn(eeprom.getBool(TOOLCHGONPWRON, true));
	eeprom.end();
}

/**
 *  Writes the RouterSetup to EEPROM
 */
void RouterSetup::saveToEEPROM() {
	eeprom.begin(ROUTER_NAMESPACE, false);
	eeprom.putFloat(SPEED, getSpeed());
	eeprom.putFloat(ACCELERATION, getAcceleration());
	eeprom.putUInt(STEPSPERREV, getStepsPerRev());
	eeprom.putInt(PITCH, getPitch());
	eeprom.putFloat(TOOLLENGHTSNHT, getToolLenghtSensorHeight());
	eeprom.putInt(ENCSPEEDSLOW, getEncoderSpeedSlow());
	eeprom.putInt(ENCSPEEDFAST, getEncoderSpeedFast());
	eeprom.putFloat(LVLHEIGHTDIVE, getLevelHeightDiving());
	eeprom.putBool(TOOLCHGONPWRON, isToolChangOnPowerOn());
	eeprom.end();
}


void RouterSetup::printValues() {
	Serial.print(String(SPEED) + ": " + String(getSpeed(), 1) + ", ");
	Serial.print(String(ACCELERATION) + ": " + String(getAcceleration(), 1) + ", ");
	Serial.print(String(STEPSPERREV) + ": " + String(getStepsPerRev()) + ", ");
	Serial.print(String(PITCH) + ": " + String(getPitch(), 1) + ", ");
	Serial.print(String(TOOLLENGHTSNHT) + ": " + String(getToolLenghtSensorHeight(), 2) + ", ");
	Serial.print(String(ENCSPEEDSLOW) + ": " + String(getEncoderSpeedSlow()) + ", ");
	Serial.print(String(ENCSPEEDFAST) + ": " + String(getEncoderSpeedFast()) + ", ");
	Serial.print(String(LVLHEIGHTDIVE) + ": " + String(getLevelHeightDiving(), 2) + ", ");
	Serial.println(String(TOOLCHGONPWRON) + ": " + String(isToolChangOnPowerOn()));
}