[nv14] Fixed unknown type

This commit is contained in:
Raphael Coeffic
2021-07-31 17:52:28 +02:00
parent 34c588d9f6
commit b8ee83da32
@@ -373,75 +373,59 @@ void Parse_Character(STRUCT_HALL *hallBuffer, unsigned char ch)
if (parse_ps_state != 0) return; if (parse_ps_state != 0) return;
parse_ps_state = 1; parse_ps_state = 1;
switch( hallBuffer->status ) switch (hallBuffer->status) {
{ case GET_START: {
case GET_START: if (FLYSKY_HALL_PROTOLO_HEAD == ch) {
{ hallBuffer->head = FLYSKY_HALL_PROTOLO_HEAD;
if ( FLYSKY_HALL_PROTOLO_HEAD == ch )
{
hallBuffer->head = FLYSKY_HALL_PROTOLO_HEAD;
hallBuffer->status = GET_ID; hallBuffer->status = GET_ID;
hallBuffer->msg_OK = 0; hallBuffer->msg_OK = 0;
} }
break; break;
} }
case GET_ID: case GET_ID: {
{
hallBuffer->hallID.ID = ch; hallBuffer->hallID.ID = ch;
hallBuffer->status = GET_LENGTH; hallBuffer->status = GET_LENGTH;
break; break;
} }
case GET_LENGTH: case GET_LENGTH: {
{
hallBuffer->length = ch; hallBuffer->length = ch;
hallBuffer->dataIndex = 0; hallBuffer->dataIndex = 0;
hallBuffer->status = GET_DATA; hallBuffer->status = GET_DATA;
if( 0 == hallBuffer->length ) if (0 == hallBuffer->length) {
{
hallBuffer->status = GET_CHECKSUM; hallBuffer->status = GET_CHECKSUM;
hallBuffer->checkSum=0; hallBuffer->checkSum = 0;
} }
break; break;
} }
case GET_DATA: case GET_DATA: {
{
hallBuffer->data[hallBuffer->dataIndex++] = ch; hallBuffer->data[hallBuffer->dataIndex++] = ch;
if( hallBuffer->dataIndex >= hallBuffer->length) if (hallBuffer->dataIndex >= hallBuffer->length) {
{
hallBuffer->checkSum = 0; hallBuffer->checkSum = 0;
hallBuffer->dataIndex = 0; hallBuffer->dataIndex = 0;
hallBuffer->status = GET_STATE; hallBuffer->status = GET_STATE;
} }
break; break;
} }
case GET_STATE: case GET_STATE: {
{
hallBuffer->checkSum = 0; hallBuffer->checkSum = 0;
hallBuffer->dataIndex = 0; hallBuffer->dataIndex = 0;
hallBuffer->status = GET_CHECKSUM; hallBuffer->status = GET_CHECKSUM;
} }
case GET_CHECKSUM: case GET_CHECKSUM: {
{
hallBuffer->checkSum |= ch << ((hallBuffer->dataIndex++) * 8); hallBuffer->checkSum |= ch << ((hallBuffer->dataIndex++) * 8);
if( hallBuffer->dataIndex >= 2 ) if (hallBuffer->dataIndex >= 2) {
{
hallBuffer->dataIndex = 0; hallBuffer->dataIndex = 0;
hallBuffer->status = CHECKSUM; hallBuffer->status = CHECKSUM;
} } else {
else
{
break; break;
} }
} }
case CHECKSUM: case CHECKSUM: {
{ if (hallBuffer->checkSum ==
if(hallBuffer->checkSum == calc_crc16( (U8*)&hallBuffer->head, hallBuffer->length + 3 ) ) calc_crc16((void *)&hallBuffer->head, hallBuffer->length + 3)) {
{
hallBuffer->msg_OK = 1; hallBuffer->msg_OK = 1;
goto Label_restart; goto Label_restart;
} } else {
else
{
goto Label_error; goto Label_error;
} }
} }
@@ -449,12 +433,12 @@ void Parse_Character(STRUCT_HALL *hallBuffer, unsigned char ch)
goto exit; goto exit;
Label_error: Label_error:
Label_restart: Label_restart:
hallBuffer->status = GET_START; hallBuffer->status = GET_START;
exit: exit:
parse_ps_state = 0; parse_ps_state = 0;
return; return;
} }
void convert_hall_to_adc_value( void ) void convert_hall_to_adc_value( void )