#include <iostream>

#include "BuoyancyEngine.hpp"
#include "ConfigData.hpp"

BuoyancyEngine::Status changeBuoyancy(int8_t dir, float speed);

BuoyancyEngine::Status BuoyancyEngine::submerge()
{
	return changeBuoyancy(BuoyancyEngine::descendMotorDir, ConfigData::getSubmergePumpSpeed_pctMax());
}


BuoyancyEngine::Status changeBuoyancy(int8_t dir, float speed)
{
	float motorSpeed_pctMax = dir * speed;
	std::cout << "Sending motor speed command (pctMax): " << motorSpeed_pctMax << std::endl;
}