add '{pwm' decoding support

This commit is contained in:
Denis Ahrens
2013-02-03 04:38:00 +01:00
parent de8d762534
commit 7ea2001e49
2 changed files with 8 additions and 0 deletions

View File

@ -102,6 +102,11 @@ void printSI16(SMCVal_t val)
printf("%d ", ntohs(*(SInt16*)val.bytes));
}
void printPWM(SMCVal_t val)
{
printf("%.1f%% ", ntohs(*(UInt16*)val.bytes) * 100 / 65536.0);
}
void printBytesHex(SMCVal_t val)
{
int i;
@ -129,6 +134,8 @@ void printVal(SMCVal_t val)
printSI8(val);
else if (strcmp(val.dataType, DATATYPE_SI16) == 0 && val.dataSize == 2)
printSI16(val);
else if (strcmp(val.dataType, DATATYPE_PWM) == 0 && val.dataSize == 2)
printPWM(val);
printBytesHex(val);
}

View File

@ -45,6 +45,7 @@
#define DATATYPE_SP78 "sp78"
#define DATATYPE_SI8 "si8 "
#define DATATYPE_SI16 "si16"
#define DATATYPE_PWM "{pwm"
typedef struct {
char major;