initial commit

Investigation/bussniffer/src/main.cpp

@@ -0,0 +1,81 @@
+#include <Arduino.h>
+#include <SoftwareSerial.h>
+
+
+SoftwareSerial RS485(D6,D7);
+#define RS485IF RS485
+//#define RS485IF Serial
+
+
+void setup()
+{
+  // Hörmann HCP2 based on modbus rtu @57.6kB 8E1  
+  RS485IF.begin(57600,SWSERIAL_8E1);
+  Serial.begin(115200,SERIAL_8N1);
+}
+
+#define T3_5 1750
+
+#define BUFFERSIZE 255
+int rxlen = 0;
+int txlen = 0;
+byte rxbbuffer[BUFFERSIZE];
+byte txbbuffer[BUFFERSIZE];
+
+unsigned long recvTime =0;
+unsigned long recvStartTime =0;
+unsigned long recvGapTime = 0;
+
+void sendUShort(ushort data){
+  Serial.write(data>>8);
+  Serial.write(data&0xFF);
+}
+
+int loopcount = 0;
+void loop()
+{
+  if(loopcount==0)
+  {    
+    rxlen=0;
+    rxbbuffer[rxlen++] = 0x8;
+    rxbbuffer[rxlen++] = 0xDE;
+    rxbbuffer[rxlen++] = 0xAD;
+    rxbbuffer[rxlen++] = 0xBE;
+    rxbbuffer[rxlen++] = 0xEF;
+    rxbbuffer[rxlen++] = 0xDE;
+    rxbbuffer[rxlen++] = 0xAD;
+    rxbbuffer[rxlen++] = 0xBE;
+    rxbbuffer[rxlen++] = 0xEF;    
+    
+    Serial.write(rxbbuffer,rxlen);  
+
+    rxlen=0;
+    loopcount=1;
+  }
+
+  if(RS485IF.available() >0)
+  {
+      if(rxlen==0){
+        recvStartTime = micros();
+        recvGapTime = recvStartTime-recvTime;
+      }
+      rxlen+= RS485IF.readBytes((char*)(rxbbuffer+rxlen), _min(BUFFERSIZE-rxlen,RS485IF.available()));
+      recvTime = micros(); 
+      
+  }
+
+  if(rxlen>0 && (micros()-recvTime > T3_5 || rxlen > 0x80)) 
+  {    
+    Serial.write(rxlen);                            // Len
+    sendUShort((short)recvGapTime);                 // Gap
+    sendUShort((short)recvTime-recvStartTime);    // Packagelen
+    Serial.write(rxbbuffer,rxlen);
+    rxlen=0;
+  }
+
+  if(Serial.available() >0)
+  {
+      rxlen= Serial.readBytes((char*)(rxbbuffer), _min(BUFFERSIZE,Serial.available()));
+      RS485IF.write(rxbbuffer,rxlen);
+  }
+}