added value cap to laser and motorValues

This commit is contained in:
FrYakaTKoP
2017-10-09 22:13:09 +02:00
parent 030f714fd5
commit 56822cf17e

View File

@@ -119,7 +119,14 @@ void handleFileList() {
void handleLaser(String uri)
{
String laserValue = uri.substring(7);
lmValues[0] = laserValue.toInt();
if(laserValue.toInt() > 128) {
lmValues[0] = 128;
laserValue = "128";
}
else
{
lmValues[0] = laserValue.toInt();
}
String msg = "AT SLV ";
msg += laserValue;
@@ -138,9 +145,15 @@ void handleLaser(String uri)
void handleMotor(String uri)
{
String motorNr = uri.substring(7, 8);
String motorValue = uri.substring(9);
lmValues[motorNr.toInt()] = motorValue.toInt();
String motorValue = uri.substring(9);
if(motorValue.toInt() > 128) {
lmValues[motorNr.toInt()] = 128;
motorValue = "128";
}
else
{
lmValues[motorNr.toInt()] = motorValue.toInt();
}
String msg = "AT SMS ";
msg += motorNr;
msg += " ";