Arduino-Modbus_Tcp通讯协议库

#include "MgsModbus.h" // For Arduino 1.0 EthernetServer MbServer(MB_PORT); EthernetClient MbmClient; // #define DEBUG MgsModbus::MgsModbus() { } //****************** Send data for ModBusMaster **************** void MgsModbus::Req(MB_FC FC, word Ref, word Count, word Pos) { MbmFC = FC; byte ServerIp[] = {192,168,200,163}; MbmByteArray[0] = 0; // ID high byte MbmByteArray[1] = 1; // ID low byte MbmByteArray[2] = 0; // protocol high byte MbmByteArray[3] = 0; // protocol low byte MbmByteArray[5] = 6; // Lenght low byte; MbmByteArray[4] = 0; // Lenght high byte MbmByteArray[6] = 1; // unit ID MbmByteArray[7] = FC; // function code MbmByteArray[8] = highByte(Ref); MbmByteArray[9] = lowByte(Ref); //****************** Read Coils (1) & Read Input discretes (2) ********************** if(FC == MB_FC_READ_COILS || FC == MB_FC_READ_DISCRETE_INPUT) { if (Count < 1) {Count = 1;} if (Count > 125) {Count = 2000;} MbmByteArray[10] = highByte(Count); MbmByteArray[11] = lowByte(Count); } //****************** Read Registers (3) & Read Input registers (4) ****************** if(FC == MB_FC_READ_REGISTERS || FC == MB_FC_READ_INPUT_REGISTER) { if (Count < 1) {Count = 1;} if (Count > 125) {Count = 125;} MbmByteArray[10] = highByte(Count); MbmByteArray[11] = lowByte(Count); } //****************** Write Coil (5) ********************** if(MbmFC == MB_FC_WRITE_COIL) { if (GetBit(Pos)) {MbmByteArray[10] = 0xFF;} else {MbmByteArray[10] = 0;} // 0xFF coil on 0x00 coil off MbmByteArray[11] = 0; // always zero } //****************** Write Register (6) ****************** if(MbmFC == MB_FC_WRITE_REGISTER) { MbmByteArray[10] = highByte(MbData[Pos]); MbmByteArray[11] = lowByte(MbData[Pos]); } //****************** Write Multiple Coils (15) ********************** // not fuly tested if(MbmFC == MB_FC_WRITE_MULTIPLE_COILS) { if (Count < 1) {Count = 1;} if (Count > 800) {Count = 800;} MbmByteArray[10] = highByte(Count); MbmByteArray[11] = lowByte(Count); MbmByteArray[12] = (Count + 7) /8; MbmByteArray[4] = highByte(MbmByteArray[12] + 7); // Lenght high byte MbmByteArray[5] = lowByte(MbmByteArray[12] + 7); // Lenght low byte; for (int i=0; i<Count; i++) { bitWrite(MbmByteArray[13+(i/8)],i-((i/8)*8),GetBit(Pos+i)); } } //****************** Write Multiple Registers (16) ****************** if(MbmFC == MB_FC_WRITE_MULTIPLE_REGISTERS) { if (Count < 1) {Count = 1;} if (Count > 100) {Count = 100;} MbmByteArray[10] = highByte(Count); MbmByteArray[11] = lowByte(Count); MbmByteArray[12] = (Count*2); MbmByteArray[4] = highByte(MbmByteArray[12] + 7); // Lenght high byte MbmByteArray[5] = lowByte(MbmByteArray[12] + 7); // Lenght low byte; for (int i=0; i<Count;i++) { MbmByteArray[(i*2)+13] = highByte (MbData[Pos + i]); MbmByteArray[(i*2)+14] = lowByte (MbData[Pos + i]); } } //****************** ?? ****************** if (MbmClient.connect(ServerIp,502)) { #ifdef DEBUG Serial.println("connected with modbus slave"); Serial.print("Master request: "); for(int i=0;i<MbmByteArray[5]+6;i++) { if(MbmByteArray[i] < 16){Serial.print("0");} Serial.print(MbmByteArray[i],HEX); if (i != MbmByteArray[5]+5) {Serial.print(".");} else {Serial.println();} } #endif for(int i=0;i<MbmByteArray[5]+6;i++) { MbmClient.write(MbmByteArray[i]); } MbmCounter = 0; MbmByteArray[7] = 0; MbmPos = Pos; MbmBitCount = Count; } else { #ifdef DEBUG Serial.println("connection with modbus master failed"); #endif MbmClient.stop(); } } //****************** Recieve data for ModBusMaster **************** void MgsModbus::MbmRun() { //****************** Read from socket **************** while (MbmClient.available()) { MbmByteArray[MbmCounter] = MbmClient.read(); if (MbmCounter > 4) { if (MbmCounter == MbmByteArray[5] + 5) { // the full answer is recieved MbmClient.stop(); MbmProcess(); #ifdef DEBUG Serial.println("recieve klaar"); #endif } } MbmCounter++; } } void MgsModbus::MbmProcess() { MbmFC = SetFC(int (MbmByteArray[7])); #ifdef DEBUG for (int i=0;i<MbmByteArray[5]+6;i++) { if(MbmByteArray[i] < 16) {Serial.print("0");} Serial.print(MbmByteArray[i],HEX); if (i != MbmByteArray[5]+5) {Serial.print("."); } else {Serial.println();} } #endif //****************** Read Coils (1) & Read Input discretes (2) ********************** if(MbmFC == MB_FC_READ_COILS || MbmFC == MB_FC_READ_DISCRETE_INPUT) { word Count = MbmByteArray[8] * 8; if (MbmBitCount < Count) { Count = MbmBitCount; } for (int i=0;i<Count;i++) { if (i + MbmPos < MbDataLen * 16) { SetBit(i + MbmPos,bitRead(MbmByteArray[(i/8)+9],i-((i/8)*8))); } } } //****************** Read Registers (3) & Read Input registers (4) ****************** if(MbmFC == MB_FC_READ_REGISTERS || MbmFC == MB_FC_READ_INPUT_REGISTER) { word Pos = MbmPos; for (int i=0;i<MbmByteArray[8];i=i+2) { if (Pos < MbDataLen) { MbData[Pos] = (MbmByteArray[i+9] * 0x100) + MbmByteArray[i+1+9]; Pos++; } } } //****************** Write Coil (5) ********************** if(MbmFC == MB_FC_WRITE_COIL){ } //****************** Write Register (6) ****************** if(MbmFC == MB_FC_WRITE_REGISTER){ } //****************** Write Multiple Coils (15) ********************** if(MbmFC == MB_FC_WRITE_MULTIPLE_COILS){ } //****************** Write Multiple Registers (16) ****************** if(MbmFC == MB_FC_WRITE_MULTIPLE_REGISTERS){ } } //****************** Recieve data for ModBusSlave **************** void MgsModbus::MbsRun() { //****************** Read from socket **************** EthernetClient client = MbServer.available(); if(client.available()) { delay(10); int i = 0; while(client.available()) { MbsByteArray[i] = client.read(); i++; } MbsFC = SetFC(MbsByteArray[7]); //Byte 7 of request is FC } int Start, WordDataLength, ByteDataLength, CoilDataLength, MessageLength; //****************** Read Coils (1 & 2) ********************** if(MbsFC == MB_FC_READ_COILS || MbsFC == MB_FC_READ_DISCRETE_INPUT) { Start = word(MbsByteArray[8],MbsByteArray[9]); CoilDataLength = word(MbsByteArray[10],MbsByteArray[11]); ByteDataLength = CoilDataLength / 8; if(ByteDataLength * 8 < CoilDataLength) ByteDataLength++; CoilDataLength = ByteDataLength * 8; MbsByteArray[5] = ByteDataLength + 3; //Number of bytes after this one. MbsByteArray[8] = ByteDataLength; //Number of bytes after this one (or number of bytes of data). for(int i = 0; i < ByteDataLength ; i++) { MbsByteArray[9 + i] = 0; // To get all remaining not written bits zero for(int j = 0; j < 8; j++) { bitWrite(MbsByteArray[9 + i], j, GetBit(Start + i * 8 + j)); } } MessageLength = ByteDataLength + 9; client.write(MbsByteArray, MessageLength); MbsFC = MB_FC_NONE; } //****************** Read Registers (3 & 4) ****************** if(MbsFC == MB_FC_READ_REGISTERS || MbsFC == MB_FC_READ_INPUT_REGISTER) { Start = word(MbsByteArray[8],MbsByteArray[9]); WordDataLength = word(MbsByteArray[10],MbsByteArray[11]); ByteDataLength = WordDataLength * 2; MbsByteArray[5] = ByteDataLength + 3; //Number of bytes after this one. MbsByteArray[8] = ByteDataLength; //Number of bytes after this one (or number of bytes of data). for(int i = 0; i < WordDataLength; i++) { MbsByteArray[ 9 + i * 2] = highByte(MbData[Start + i]); MbsByteArray[10 + i * 2] = lowByte(MbData[Start + i]); } MessageLength = ByteDataLength + 9; client.write(MbsByteArray, MessageLength);