|
|
@ -159,6 +159,11 @@ GoosePublisher_increaseStNum(GoosePublisher self)
|
|
|
|
MmsValue_setUtcTimeMs(self->timestamp, currentTime);
|
|
|
|
MmsValue_setUtcTimeMs(self->timestamp, currentTime);
|
|
|
|
|
|
|
|
|
|
|
|
self->stNum++;
|
|
|
|
self->stNum++;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* check for overflow */
|
|
|
|
|
|
|
|
if (self->stNum == 0)
|
|
|
|
|
|
|
|
self->stNum = 1;
|
|
|
|
|
|
|
|
|
|
|
|
self->sqNum = 0;
|
|
|
|
self->sqNum = 0;
|
|
|
|
|
|
|
|
|
|
|
|
return currentTime;
|
|
|
|
return currentTime;
|
|
|
@ -387,11 +392,14 @@ GoosePublisher_publish(GoosePublisher self, LinkedList dataSet)
|
|
|
|
|
|
|
|
|
|
|
|
int32_t payloadLength = createGoosePayload(self, dataSet, buffer, maxPayloadSize);
|
|
|
|
int32_t payloadLength = createGoosePayload(self, dataSet, buffer, maxPayloadSize);
|
|
|
|
|
|
|
|
|
|
|
|
self->sqNum++;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (payloadLength == -1)
|
|
|
|
if (payloadLength == -1)
|
|
|
|
return -1;
|
|
|
|
return -1;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
self->sqNum++;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (self->sqNum == 0)
|
|
|
|
|
|
|
|
self->sqNum = 1;
|
|
|
|
|
|
|
|
|
|
|
|
int lengthIndex = self->lengthField;
|
|
|
|
int lengthIndex = self->lengthField;
|
|
|
|
|
|
|
|
|
|
|
|
size_t gooseLength = payloadLength + 8;
|
|
|
|
size_t gooseLength = payloadLength + 8;
|
|
|
|