int
main(int argc, char** argv)
{
MmsValue* dataSetValues = MmsValue_createEmtpyArray(4);
int i;
for (i = 0; i < 4; i++) {
MmsValue* dataSetEntry = MmsValue_newBoolean(false);
MmsValue_setElement(dataSetValues, i, dataSetEntry);
}
// GooseSubscriber subscriber = GooseSubscriber_create("simpleIOGenericIO/LLN0$GO$gcbEvents", dataSetValues);
GooseSubscriber subscriber = GooseSubscriber_create("simpleIOGenericIO/LLN0$GO$gcbAnalogValues", NULL);
if (argc > 1) {
printf("Set interface id: %s\n", argv[1]);
GooseSubscriber_setInterfaceId(subscriber, argv[1]);
}
GooseSubscriber_setAppId(subscriber, 1000);
GooseSubscriber_setListener(subscriber, gooseListener, NULL);
GooseSubscriber_subscribe(subscriber);
signal(SIGINT, sigint_handler);
while (running) {
Thread_sleep(100);
}
GooseSubscriber_destroy(subscriber);
}
MmsValue*
mmsClient_parseReadResponse(ByteBuffer* message, uint32_t* invokeId)
{
MmsPdu_t* mmsPdu = 0; /* allow asn1c to allocate structure */
MmsIndication retVal = MMS_OK;
MmsValue* valueList = NULL;
MmsValue* value = NULL;
asn_dec_rval_t rval;
rval = ber_decode(NULL, &asn_DEF_MmsPdu,
(void**) &mmsPdu, ByteBuffer_getBuffer(message), ByteBuffer_getSize(message));
if (DEBUG) xer_fprint(stdout, &asn_DEF_MmsPdu, mmsPdu);
if (mmsPdu->present == MmsPdu_PR_confirmedResponsePdu) {
*invokeId = mmsClient_getInvokeId(&mmsPdu->choice.confirmedResponsePdu);
if (mmsPdu->choice.confirmedResponsePdu.confirmedServiceResponse.present == ConfirmedServiceResponse_PR_read) {
ReadResponse_t* response = &(mmsPdu->choice.confirmedResponsePdu.confirmedServiceResponse.choice.read);
int elementCount = response->listOfAccessResult.list.count;
if (elementCount > 1)
valueList = MmsValue_createEmtpyArray(elementCount);
int i = 0;
for (i = 0; i < elementCount; i++) {
value = NULL;
AccessResult_PR presentType = response->listOfAccessResult.list.array[i]->present;
if (presentType == AccessResult_PR_failure) {
if (DEBUG) printf("access error!\n");
retVal = MMS_ERROR;
}
else if (presentType == AccessResult_PR_array) {
value = calloc(1, sizeof(MmsValue));
value->type = MMS_ARRAY;
int elementCount =
response->listOfAccessResult.list.array[i]->choice.array.list.count;
value->value.array.size = elementCount;
value->value.array.components = calloc(elementCount, sizeof(MmsValue*));
int j;
for (j = 0; j < elementCount; j++) {
value->value.array.components[j] = mmsMsg_parseDataElement(
response->listOfAccessResult.list.array[i]->choice.array.list.array[j]);
}
}
else if (presentType == AccessResult_PR_structure) {
value = calloc(1, sizeof(MmsValue));
value->type = MMS_STRUCTURE;
int componentCount =
response->listOfAccessResult.list.array[i]->choice.structure.list.count;
value->value.structure.componentCount = componentCount;
value->value.structure.components = calloc(componentCount, sizeof(MmsValue*));
int j;
for (j = 0; j < componentCount; j++) {
value->value.structure.components[j] = mmsMsg_parseDataElement(
response->listOfAccessResult.list.array[i]->choice.structure.list.array[j]);
}
}
else if (presentType == AccessResult_PR_bitstring) {
value = calloc(1, sizeof(MmsValue));
value->type = MMS_BIT_STRING;
int size = response->listOfAccessResult.list.array[i]->choice.bitstring.size;
value->value.bitString.size = (size * 8)
- response->listOfAccessResult.list.array[i]->choice.bitstring.bits_unused;
value->value.bitString.buf = malloc(size);
memcpy(value->value.bitString.buf,
response->listOfAccessResult.list.array[i]->choice.bitstring.buf, size);
}
else if (presentType == AccessResult_PR_integer) {
long integerValue;
asn_INTEGER2long(&response->listOfAccessResult.list.array[i]->choice.integer, &integerValue);
value = MmsValue_newIntegerFromInt32((int32_t) integerValue);
}
else if (presentType == AccessResult_PR_floatingpoint) {
int size = response->listOfAccessResult.list.array[i]->choice.floatingpoint.size;
value = calloc(1, sizeof(MmsValue));
value->type = MMS_FLOAT;
if (size == 5) { /* FLOAT32 */
value->value.floatingPoint.formatWidth = 32;
value->value.floatingPoint.exponentWidth = response->listOfAccessResult.list.array[i]->choice.floatingpoint.buf[0];
uint8_t* floatBuf = (response->listOfAccessResult.list.array[i]->choice.floatingpoint.buf + 1);
value->value.floatingPoint.buf = malloc(4);
#ifdef ORDER_LITTLE_ENDIAN
memcpyReverseByteOrder(value->value.floatingPoint.buf, floatBuf, 4);
#else
memcpy(value->value.floatingPoint.buf, floatBuf, 4);
#endif
}
if (size == 9) { /* FLOAT64 */
value->value.floatingPoint.formatWidth = 64;
value->value.floatingPoint.exponentWidth = response->listOfAccessResult.list.array[i]->choice.floatingpoint.buf[0];
uint8_t* floatBuf = (response->listOfAccessResult.list.array[i]->choice.floatingpoint.buf + 1);
value->value.floatingPoint.buf = malloc(8);
#ifdef ORDER_LITTLE_ENDIAN
memcpyReverseByteOrder(value->value.floatingPoint.buf, floatBuf, 8);
#else
memcpy(value->value.floatingPoint.buf, floatBuf, 8);
#endif
}
}
else if (presentType == AccessResult_PR_utctime) {
value->type = MMS_UTC_TIME;
memcpy(value->value.utcTime,
response->listOfAccessResult.list.array[i]->choice.utctime.buf, 8);
}
else {
printf("unknown type\n");
retVal = MMS_ERROR;
}
if (elementCount > 1)
MmsValue_setArrayElement(valueList, i, value);
}
}
else {
retVal = MMS_ERROR;
}
}
else {
retVal = MMS_ERROR;
}
asn_DEF_MmsPdu.free_struct(&asn_DEF_MmsPdu, mmsPdu, 0);
if (valueList == NULL)
valueList = value;
return valueList;
}
static void
alternateArrayAccess(MmsServerConnection* connection,
AlternateAccess_t* alternateAccess, MmsDomain* domain,
char* itemId, LinkedList values,
MmsTypeSpecification* namedVariable)
{
if (mmsServer_isIndexAccess(alternateAccess))
{
int lowIndex = mmsServer_getLowIndex(alternateAccess);
int numberOfElements = mmsServer_getNumberOfElements(alternateAccess);
if (DEBUG) printf("Alternate access index: %i elements %i\n",
lowIndex, numberOfElements);
int index = lowIndex;
MmsValue* value = NULL;
MmsValue* arrayValue = mmsServer_getValue(connection->server, domain, itemId);
if (arrayValue != NULL) {
if (numberOfElements == 0)
if (isAccessToArrayComponent(alternateAccess)) {
if (namedVariable->typeSpec.array.elementTypeSpec->type == MMS_STRUCTURE) {
MmsValue* structValue = MmsValue_getElement(arrayValue, index);
if (structValue != NULL)
value = getComponentOfArrayElement(alternateAccess,
namedVariable, structValue);
}
}
else
value = MmsValue_getElement(arrayValue, index);
else {
value = MmsValue_createEmtpyArray(numberOfElements);
MmsValue_setDeletable(value);
int resultIndex = 0;
while (index < lowIndex + numberOfElements) {
MmsValue* elementValue = NULL;
elementValue = MmsValue_getElement(arrayValue, index);
if (!MmsValue_isDeletable(elementValue))
elementValue = MmsValue_clone(elementValue);
MmsValue_setElement(value, resultIndex, elementValue);
index++;
resultIndex++;
}
}
appendValueToResultList(value, values);
if (MmsValue_isDeletable(arrayValue))
MmsValue_delete(arrayValue);
}
else /* access error */
appendErrorToResultList(values, 10 /* object-non-existant*/);
}
else { // invalid access
if (DEBUG) printf("Invalid alternate access\n");
appendErrorToResultList(values, 10 /* object-non-existant*/);
}
}
