Revision 0:b047a1b6f8a3, committed 2022-05-26

Comitter:

caa45040

Date:

Thu May 26 10:00:15 2022 +0000

Commit message:

modbus rtu crc

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu May 26 10:00:15 2022 +0000
@@ -0,0 +1,158 @@
+//modbus_RTU_CRC_010_1
+
+#include "mbed.h"
+
+//プロトタイプ宣言
+unsigned short calc_crc(unsigned char *buf, int length);
+
+
+//10の割り算 0から1028までは、正しい。主に0から999
+#define DIV10(n) ((n*205)>>11)
+
+
+#define UART_DELAY 101 //  1/9600 98-105
+
+DigitalOut TX(PA_2);
+
+//仮想シリアルへの一文字出力 9600bps
+int pc_putc(char ch)
+{
+
+    TX=1;
+    TX=0;//Start
+    wait_us(UART_DELAY);
+
+    for(int ii=0; ii<8; ii++) { //Data x 8
+        TX=(ch>>ii)&1;
+        wait_us(UART_DELAY);
+    }; //for
+
+    TX=1;//Stop
+    wait_us(UART_DELAY);
+
+    return(0);
+
+} //pc_putc
+
+
+
+//文字列の表示
+int pc_printf(char *str1)
+{
+
+    //文字の中身がゼロか
+    while (*str1) {
+
+        //一文字出力
+        pc_putc(*str1 ++);
+
+    } //while
+
+    //戻り値
+    return (0);
+}//pc_printf
+
+
+void pc_printf_num(int num1)
+{
+
+    //表示 debug
+    char out_buff[8];
+    out_buff[3] = 0;
+    out_buff[2] = '0' + (  num1 - (DIV10(num1) * 10)  );  // '0'+(b%10)
+    num1 = DIV10(num1);
+    out_buff[1] = '0' + (  num1 - (DIV10(num1) * 10)  );  // '0'+(b%10)
+    out_buff[0] = '0' +  DIV10(num1);                  // '0'+(s/10)
+
+    //送信処理
+    //send 8 byte
+    pc_printf(out_buff);
+    //pc_printf("\r\n");
+
+}// pc_printf_num
+
+
+char c_hex[] = {
+    '0', '1', '2', '3', '4', '5', '6', '7',
+    '8', '9', 'A', 'B', 'C', 'D', 'E', 'F'
+};
+
+void pc_printf_hex(char ch1)
+{
+
+
+    //デバッグ用出力に送信
+    //ヘキサに値を設定
+    // packet move
+    char out_buff[8];
+    out_buff[0] = '[';
+    out_buff[1] = c_hex[(ch1 >> 4) & 0x0f];
+    out_buff[2] = c_hex[ch1 & 0x0f];
+    out_buff[3] = ']';
+    out_buff[4] = 0x00;
+
+    //送信処理
+    //send 8 byte
+    pc_printf(out_buff);
+    //pc_printf("\r\n");
+
+}//pc_printf_hex
+
+
+//メイン関数
+int main()
+{
+
+    pc_printf("<ST>\r\n");
+
+
+    //無限ループ
+    while(1) {
+
+        pc_printf_num(123);
+        pc_printf("\r\n");
+
+        pc_printf_hex(0x12);
+        pc_printf("\r\n");
+
+        unsigned char buff1[] = { 0x01, 0x06, 0, 0, 1, 1 };
+
+        int ret = calc_crc( buff1, 6);
+
+        pc_printf("-01 06 00 00 01 01-");
+        pc_printf_hex((char)  (  ret     & 0xff)   );
+        pc_printf_hex((char)  ( (ret>>8) & 0xff)   );
+        pc_printf("\r\n");
+        pc_printf("-49--9a-\r\n");
+
+        //2秒の待ち
+        wait_ms(2000);    //debug
+
+    }//whil
+
+
+} //main
+
+
+// buf    受信データ
+// length 受信データ長(CRCを除く)
+unsigned short calc_crc(unsigned char *buf, int length)
+{
+    unsigned short crc = 0xFFFF;
+    int i,j;
+    unsigned char carrayFlag;
+    for (i = 0; i < length; i++) {
+        crc ^= buf[i];
+        for (j = 0; j < 8; j++) {
+            carrayFlag = crc & 1;
+            crc = crc >> 1;
+            if (carrayFlag) {
+                crc ^= 0xA001;
+            }
+        }
+    }
+    return crc;
+}
+
+
+void error(const char* format, ...) {}

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed.bld	Thu May 26 10:00:15 2022 +0000
@@ -0,0 +1,1 @@
+https://mbed.org/users/mbed_official/code/mbed/builds/86740a56073b
\ No newline at end of file