Начало
This commit is contained in:
parent
d552803f86
commit
8c8ddb2836
|
|
@ -32,15 +32,15 @@ void SerialCommand_Scheduler(tTaskSerial *env) {
|
||||||
|
|
||||||
uint8_t data[8];
|
uint8_t data[8];
|
||||||
uint32_t adr = iAsciiStringParseUnsignedLongDecimalNumber(&env->At.rxBuffer.data[1],
|
uint32_t adr = iAsciiStringParseUnsignedLongDecimalNumber(&env->At.rxBuffer.data[1],
|
||||||
&env->At.rxBuffer.data[9]);
|
&env->At.rxBuffer.data[7]);
|
||||||
|
|
||||||
uint8_t len = &env->At.rxBuffer.data[env->At.rxBuffer.len] - &env->At.rxBuffer.data[9] - 2;
|
uint8_t len = &env->At.rxBuffer.data[env->At.rxBuffer.len] - &env->At.rxBuffer.data[7] - 2;
|
||||||
|
|
||||||
if (len > 16) {
|
if (len > 16) {
|
||||||
len = 16;
|
len = 16;
|
||||||
}
|
}
|
||||||
|
|
||||||
uint8_t size = iAsciiStringParseHexBytes(data, &env->At.rxBuffer.data[9], len);
|
uint8_t size = iAsciiStringParseHexBytes(data, &env->At.rxBuffer.data[7], len);
|
||||||
|
|
||||||
env->ioCAN->transmit(env->ioCAN->env, data, size, adr, 0, env->numberMailBox, 1000);
|
env->ioCAN->transmit(env->ioCAN->env, data, size, adr, 0, env->numberMailBox, 1000);
|
||||||
|
|
||||||
|
|
@ -51,15 +51,15 @@ void SerialCommand_Scheduler(tTaskSerial *env) {
|
||||||
|
|
||||||
uint8_t data[8];
|
uint8_t data[8];
|
||||||
uint32_t adr = iAsciiStringParseUnsignedLongDecimalNumber(&env->At.rxBuffer.data[1],
|
uint32_t adr = iAsciiStringParseUnsignedLongDecimalNumber(&env->At.rxBuffer.data[1],
|
||||||
&env->At.rxBuffer.data[17]);
|
&env->At.rxBuffer.data[9]);
|
||||||
|
|
||||||
uint8_t len = &env->At.rxBuffer.data[env->At.rxBuffer.len] - &env->At.rxBuffer.data[17] - 2;
|
uint8_t len = &env->At.rxBuffer.data[env->At.rxBuffer.len] - &env->At.rxBuffer.data[9] - 2;
|
||||||
|
|
||||||
if (len > 16) {
|
if (len > 16) {
|
||||||
len = 16;
|
len = 16;
|
||||||
}
|
}
|
||||||
|
|
||||||
uint8_t size = iAsciiStringParseHexBytes(data, &env->At.rxBuffer.data[17], len);
|
uint8_t size = iAsciiStringParseHexBytes(data, &env->At.rxBuffer.data[9], len);
|
||||||
|
|
||||||
env->ioCAN->transmit(env->ioCAN->env, data, size, adr, 1, env->numberMailBox, 1000);
|
env->ioCAN->transmit(env->ioCAN->env, data, size, adr, 1, env->numberMailBox, 1000);
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue