Arduino M5Atom ESP-NOW SPP Pgm

M5Atom-STA22_Teensy-Serial_ESP-NOW_rev02.ino

#include <M5Atom.h>
#include <BluetoothSerial.h>
#include <esp_now.h>
#include <WiFi.h>
int startPin=19;
int t,t_1;
int x=1;
int i=0;
int j,k;
int stime;
int rt1;
uint8_t  f9pHead[4];
uint8_t  f9pdata[172];
uint32_t itow;
uint8_t llitow,litow,uitow,uuitow;
                
int count,ci ;
String sdata;
//============================================================================================
//=========================ESP-NOW Functions==================================================
//===============================================================================
// マルチキャスト用 MAC登録 
//  M5Core2 MAC=YY:YY:YY:YY:YY:YY

 
esp_now_peer_info_t slave; //slave　peer定義
uint8_t  data[100];//12byte  4*value0,value1,value2,value3 //送信データ配列
char cdata[100];
//char  *cdata;//シリアル受信したstring　
//uint8_t  *data;//シリアル受信stiringを文字列配列にしてそれをuint8_t配列に変換する、ポインタで定義しておく　配列数が決まってからnewで再定義
 
int  dnum;//data配列の要素数
volatile int comst=0;
volatile int comtr=0;
// 送信コールバック
void OnDataSent(const uint8_t *mac_addr, esp_now_send_status_t status) {
  char macStr[18];
  snprintf(macStr, sizeof(macStr), "%02X:%02X:%02X:%02X:%02X:%02X",
           mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]);
  //Serial.print("Last Packet Sent to: ");
  //Serial.println(macStr);
  //Serial.print("Last Packet Send Status: ");
  //Serial.println(status == ESP_NOW_SEND_SUCCESS ? "Delivery Success" : "Delivery Fail");
}

// 受信コールバック
void OnDataRecv(const uint8_t *mac_addr, const uint8_t *data, int data_len) {
  char macStr[18];
  snprintf(macStr, sizeof(macStr), "%02X:%02X:%02X:%02X:%02X:%02X",
           mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]);
/*
  if (data[0] == 0x73 && data[1] == 0x74) //when data="ST" data_sending_STart
  {
             comst=1;
             stime=data[3]|data[4]<<8|data[5]<<16|data[6]<<24; //Left Shift  OR
             rt1=millis();
              //Serial.print("********stRcv=");
              //Serial.println(millis());
  }
  if (data[0] == 0x54 && data[1] == 0x52) //when data="TR" TimerReset
  {
       comtr=1;
  }
  */
  Serial.print( macStr);
    Serial.print(",");
    Serial.print(data_len);
    for ( int i = 0 ; i < data_len ; i++ ) {
    Serial.print(data[i]);
    Serial.print(" ");
   }
   Serial.println("");
   
}
//+++++++++++++++i_to_char+++++++++++++++++
// i=IntegerValueData,*d=Array pointer, n=Array start No
void  i_to_char(int i, uint8_t *d, int n)
{
  d[n] = i & 0x000000ff;
  d[n + 1] = (i & 0x0000ff00) >> 8;
  d[n + 2] = (i & 0x00ff0000) >> 16;
  d[n + 3] = (i & 0xff000000) >> 24;
}

//========================================================================

void setup() {
  M5.begin();
  pinMode(startPin,OUTPUT);//startPin Start DataSending
  Serial2.begin(115200,SERIAL_8N1,32,26);//*******M5 Atom lite Grove(baudrate,config,RX32,TX26)*******
  t_1=millis();
  //------------------------------------------------
//--------- ESP-NOW初期化--------------------------
//------------------------------------------------
  WiFi.mode(WIFI_STA);
  WiFi.disconnect();
  if (esp_now_init() == ESP_OK) {
    //Serial.println("ESPNow Init Success");
   
  } else {
    //Serial.println("ESPNow Init Failed");
   
    ESP.restart();
  }
   // マルチキャスト用Slave＜pnのM5ATOM＞ address 50:02:91:86:9B:CC
  memset(&slave, 0, sizeof(slave));
  //============M5Stack Slave AP Mac======================
  slave.peer_addr[0] = (uint8_t)0xYY;
  slave.peer_addr[1] = (uint8_t)0xYY;
  slave.peer_addr[2] = (uint8_t)0xYY;
  slave.peer_addr[3] = (uint8_t)0xYY;
  slave.peer_addr[4] = (uint8_t)0xYY;
  slave.peer_addr[5] = (uint8_t)0xYY;
  esp_err_t addStatus = esp_now_add_peer(&slave);
  if (addStatus == ESP_OK) {
    // Pair success
    Serial.println("Pair success");
  }
 //send
  //esp_err_t addStatus = esp_now_add_peer(&slave);
  
 
  // ESP-NOWコールバック登録 
  esp_now_register_send_cb(OnDataSent);
  esp_now_register_recv_cb(OnDataRecv);

//--------------------------------------------------
//--------------------------------------------------
 
}
void loop()
{
          t=millis();   
     
      //===============Serial2 REceiving==================================    
        while(Serial2.available()>0)//Ascii recieving 
         {
           f9pdata[i]=Serial2.read();
           i++;
        }
        if(i>0){
        for(j=0;j<i;j++){
          Serial.print(f9pdata[j]);
          Serial.print(",");
        }
        Serial.printf("i=%d\n\r",i);
        count=i-1;
        i=0;
        }
                
      delay(100);
                
 
//Core2 Send============MPC Slave AP Mac  target:Core2======================
        slave.peer_addr[0] = (uint8_t)0xYY;
        slave.peer_addr[1] = (uint8_t)0xYY;
        slave.peer_addr[2] = (uint8_t)0xYY;
        slave.peer_addr[3] = (uint8_t)0xYY;
        slave.peer_addr[4] = (uint8_t)0xYY;
        slave.peer_addr[5] = (uint8_t)0xYY;
        esp_err_t addStatus = esp_now_add_peer(&slave);//slave address set
        if (addStatus == ESP_OK) {
              // Pair success
               Serial.println("Pair success");
         }
    //--------sending ------------------------------------------------
    //esp_err_t result = esp_now_send(slave.peer_addr, data, sizeof(data));
     esp_err_t result = esp_now_send(slave.peer_addr, f9pdata, count);
    /*
    Serial.print("Send Status: ");
    if (result == ESP_OK) {
      Serial.println("Success");
    } else if (result == ESP_ERR_ESPNOW_NOT_INIT) {
      Serial.println("ESPNOW not Init.");
    } else if (result == ESP_ERR_ESPNOW_ARG) {
      Serial.println("Invalid Argument");
    } else if (result == ESP_ERR_ESPNOW_INTERNAL) {
      Serial.println("Internal Error");
    } else if (result == ESP_ERR_ESPNOW_NO_MEM) {
      Serial.println("ESP_ERR_ESPNOW_NO_MEM");
    } else if (result == ESP_ERR_ESPNOW_NOT_FOUND) {
      Serial.println("Peer not found.");
    } else {
      Serial.println("Not sure what happened");
    }
    */
          
}