16,10 → 16,12 |
import dongfang.mkt.frames.MotorTestResponseFrame; |
import dongfang.mkt.frames.OSDDataResponseFrame; |
import dongfang.mkt.frames.ReadExternalControlResponseFrame; |
import dongfang.mkt.frames.ReadIMUConfigurationResponseFrame; |
import dongfang.mkt.frames.ResponseFrame; |
import dongfang.mkt.frames.SetCompassHeadingResponseFrame; |
import dongfang.mkt.frames.UniversalReadParamSetResponseFrame; |
import dongfang.mkt.frames.UniversalWriteParamSetResponseFrame; |
import dongfang.mkt.frames.ReadParamSetResponseFrame; |
import dongfang.mkt.frames.WriteIMUConfigurationResponseFrame; |
import dongfang.mkt.frames.WriteParamSetResponseFrame; |
import dongfang.mkt.frames.VariablesResponseFrame; |
import dongfang.mkt.frames.VersionResponseFrame; |
|
225,6 → 227,21 |
result = f; |
break; |
} |
case 'I': { |
ReadIMUConfigurationResponseFrame f = new ReadIMUConfigurationResponseFrame(address); |
f.setConfigurationVersion(base64InputStream.readByte()); |
int length = base64InputStream.readByte(); |
f.setConfigurationSetLength(length); |
f.setData(base64InputStream.readBytes(length)); |
result = f; |
break; |
} |
case 'J': { |
WriteIMUConfigurationResponseFrame f = new WriteIMUConfigurationResponseFrame(address); |
f.setWasAccepted(base64InputStream.readByte()==1); |
result = f; |
break; |
} |
case 'k' : { |
CompassHeadingResponseFrame f = new CompassHeadingResponseFrame(address); |
base64InputStream.readSignedWords(2); |
314,7 → 331,7 |
break; |
} |
case 'S': { |
UniversalWriteParamSetResponseFrame f = new UniversalWriteParamSetResponseFrame(address); |
WriteParamSetResponseFrame f = new WriteParamSetResponseFrame(address); |
f.setParameterSetNumber(base64InputStream.readByte()); |
result = f; |
break; |
370,7 → 387,7 |
break; |
} |
case 'Q': |
UniversalReadParamSetResponseFrame f = new UniversalReadParamSetResponseFrame(address); |
ReadParamSetResponseFrame f = new ReadParamSetResponseFrame(address); |
f.setConfigurationSetNumber(base64InputStream.readByte()); |
f.setConfigurationVersion(base64InputStream.readByte()); |
int length = base64InputStream.readByte(); |