iainmon / altino Goto Github PK

bad code:

"value2-127" should be "value2=127"
"value1=-127" should be "value2=-127"

so:

void Steering2(int value1, int value2)
{
if(value1>127)
value1=127;
if(value2>127)
value2-127;
if(value1<-127)
value1=-127;
if(value2<-127)
value1=-127;
if(value1<0)
value1=128-value1;
if(value2<0)
value2=128-value2;

Sendbuf[5] = (byte)value1;
Sendbuf[24] = 1;
Sendbuf[25] = (byte)value2;
SendData(Sendbuf);

}

should be:

void Steering2(int value1, int value2)
{
if(value1>127)
value1=127;
if(value2>127)
value2=127;
if(value1<-127)
value1=-127;
if(value2<-127)
value2=-127;
if(value1<0)
value1=128-value1;
if(value2<0)
value2=128-value2;

Sendbuf[5] = (byte)value1;
Sendbuf[24] = 1;
Sendbuf[25] = (byte)value2;
SendData(Sendbuf);

}