forked from ZhuYanzhen1/miniFOC
-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
The unpacking program of medium capacity data transfer protocol was s…
…uccessfully transplanted to monitor tool.
- Loading branch information
1 parent
21fd211
commit f26872f
Showing
7 changed files
with
203 additions
and
54 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,88 @@ | ||
| // | ||
| // Created by Lao·Zhu on 2021/9/4. | ||
| // | ||
|
|
||
| #include "mainwindow.h" | ||
| #include <string> | ||
|
|
||
| volatile static unsigned char mdtp_receive_status = 0; | ||
| volatile static unsigned char mdtp_receive_number_counter = 0; | ||
| static unsigned char mdtp_receive_data_buffer[10] = {0}; | ||
|
|
||
| /*! | ||
| \brief medium capacity data transmission protocol unpacking handler | ||
| \param[in] data: data received from general receive function | ||
| \param[out] none | ||
| \retval none | ||
| */ | ||
| void MainWindow::mdtp_receive_handler(unsigned char data) { | ||
| /* data receiving finite state machine */ | ||
| switch (mdtp_receive_status) { | ||
| case 0: | ||
| /* judge whether the packet header is received */ | ||
| if (data == 0xff) { | ||
| /* enter the receive state */ | ||
| mdtp_receive_status = 1; | ||
| /* clear receive array counter */ | ||
| mdtp_receive_number_counter = 0; | ||
| /* clear the value in the buffer array */ | ||
| memset(mdtp_receive_data_buffer, 0x00, sizeof(mdtp_receive_data_buffer)); | ||
| } | ||
| break; | ||
| case 1: | ||
| /* judge whether the end of the packet is mistakenly recognized as the header */ | ||
| if (data == 0xff && mdtp_receive_number_counter != 0) { | ||
| /* an unexpected data had been received */ | ||
| /* reset to receive start of package state */ | ||
| mdtp_receive_status = 0; | ||
| /* clear receive array counter */ | ||
| mdtp_receive_number_counter = 0; | ||
| /* clear the value in the buffer array */ | ||
| memset(mdtp_receive_data_buffer, 0x00, sizeof(mdtp_receive_data_buffer)); | ||
| } else if (data != 0xff) { | ||
| /* judge whether the reception is completed or the error data is received */ | ||
| if (mdtp_receive_number_counter != 10) { | ||
| /* receive the data into the array in turn */ | ||
| mdtp_receive_data_buffer[mdtp_receive_number_counter] = data; | ||
| mdtp_receive_number_counter = mdtp_receive_number_counter + 1; | ||
| if (mdtp_receive_number_counter == 10) | ||
| mdtp_receive_status = 2; | ||
| } | ||
| } | ||
| break; | ||
| case 2: | ||
| if (data == 0xff) { | ||
| /* ready to receive the next packet */ | ||
| mdtp_receive_status = 0; | ||
| /* verify whether the pid byte is correct*/ | ||
| if ((mdtp_receive_data_buffer[0] >> 4) == (~mdtp_receive_data_buffer[0] & 0x0f)) { | ||
| unsigned char tmp_rcv_buffer[8], counter = 0; | ||
| /* judge whether the package content is all 0xff */ | ||
| if (mdtp_receive_data_buffer[1] == 0xa5 && mdtp_receive_data_buffer[9] == 0xa5) | ||
| /* fill all bytes with 0xff */ | ||
| memset(tmp_rcv_buffer, 0xff, sizeof(tmp_rcv_buffer)); | ||
| else { | ||
| /* traverse the data byte to be adjusted */ | ||
| for (; counter < 8; ++counter) | ||
| /* judge whether the adjustment bit is 1 */ | ||
| if (((mdtp_receive_data_buffer[9] >> counter) & 0x01) == 0x01) | ||
| /* fill the data byte with 0xff */ | ||
| tmp_rcv_buffer[counter] = 0xff; | ||
| else | ||
| /* copy data directly to the receiving array */ | ||
| tmp_rcv_buffer[counter] = mdtp_receive_data_buffer[counter + 1]; | ||
| } | ||
| /* call user callback function to complete the next step */ | ||
| mdtp_callback_handler(mdtp_receive_data_buffer[0] >> 4, tmp_rcv_buffer); | ||
| } | ||
| } else { /* an unexpected data had been received */ | ||
| /* reset to receive start of package state */ | ||
| mdtp_receive_status = 0; | ||
| /* clear receive array counter */ | ||
| mdtp_receive_number_counter = 0; | ||
| /* clear the value in the buffer array */ | ||
| memset(mdtp_receive_data_buffer, 0x00, sizeof(mdtp_receive_data_buffer)); | ||
| } | ||
| break; | ||
| } | ||
| } |
Oops, something went wrong.