STM32G031でmodbusのCRCを計算


x 動作確認済み　2022/5/18 8:06


x 非営利、研究調査目的で引用します。


目的
modbusも使ってみたいので
「一番難しい」CRCの計算をする


![o_con458.jpg](https://qiita-image-store.s3.ap-northeast-1.amazonaws.com/0/840352/374aa824-267e-8704-98e0-5865742d9250.jpeg)



参考


https://mcommit.hatenadiary.com/entry/2015/04/08/224244



https://qiita.com/ELIXIR/items/10810fed963fdddbf431


引用元


```c++


// 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;
}



```


プログラム


```c++



//modbus_RTU_CRC_031_1

#include <Arduino.h>

//プロトタイプ宣言
unsigned short calc_crc(unsigned char *buf, int length);


//10の割り算 0から1028までは、正しい。主に0から999
#define DIV10(n) ((n*205)>>11)


#define DW   digitalWrite
#define TX1        PA12   // 6pin
#define UART_DELAY 106  // 002-110 9600bps ok 031

//仮想シリアルへの一文字出力 9600bps
void pc_putc(char ch)
{
  DW(TX1, HIGH);

  DW(TX1, LOW);//START
  delayMicroseconds(UART_DELAY); //START BIT WAIT

  for (int ii = 0; ii < 8; ii++) {
    DW(TX1, (ch >> ii) & 1  );
    delayMicroseconds(UART_DELAY); //DATA 1-8BIT WAIT
  }//for

  DW(TX1, HIGH);//Stop
  delayMicroseconds(UART_DELAY); //StOP BIT WAIT

}//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


//初期化
void setup() {

  delay(3000); //not Delete

  //TXポートの初期化
  pinMode(TX1, OUTPUT);
  DW(TX1, HIGH);

  pc_printf("<ST>\r\n");

} //setup


//メインループ
void loop()
{

  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秒の待ち
  delay(2000);    //debug

} //loop


// 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;
}



```