Diff: PGSdisplay.c

Revision:

4:0aec01df33d2

diff -r 591190524a70 -r 0aec01df33d2 PGSdisplay.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/PGSdisplay.c	Sat Feb 22 17:17:54 2020 +0000
@@ -0,0 +1,92 @@
+
+//#include "mbed.h"
+//#include "platform/mbed_thread.h"
+
+
+#include <string.h>
+
+#include "PGSdisplay.h"
+#include "DigitalOut.h"
+
+extern DigitalOut tast;
+//RawSerial rs485(PTC17,PTC16);
+extern RawSerial rs485;
+
+
+void ev(int)
+{
+    tast=0;
+}
+
+
+
+unsigned char buf_tel[100] = {0x71,0x00,0x0D,0x71,0x43,0x1,0x1B,0x4A,0x01,0x01,  /*0x1b,0x45,0x1,*/  0x1B,0x43,1,0x33,0xD5,0x16};
+#define NO_BEFORE_DATA 13
+#define NO_WITH_DATA (NO_BEFORE_DATA + strlen(s))
+
+void putOnDisp( char *s, char boja)
+{
+    int ubb = NO_BEFORE_DATA+strlen(s)+1+1-4-2; // ubb = ukupan broj bajtova
+    buf_tel[NO_BEFORE_DATA-1]=boja;
+    memcpy(buf_tel+NO_BEFORE_DATA, s, strlen(s)+2);
+
+    char suma=0;
+    for(int i = 4; i < NO_WITH_DATA; i++) {
+        suma +=buf_tel[i];
+    }
+
+    buf_tel[NO_WITH_DATA] = suma;
+    buf_tel[NO_WITH_DATA+1] = 22;
+    buf_tel[1]=ubb>>8;
+    buf_tel[2]=ubb;
+
+
+    tast=1;
+    rs485.write(buf_tel, NO_WITH_DATA+2+2,ev);
+}
+
+void putOnDispNo(int broj, char boja)
+{
+    char s[10];
+    sprintf( s, "%d", broj);
+    putOnDisp( s, boja);
+}
+
+
+void slanjefun()
+{
+
+    int j=0;
+
+
+    while (true) {
+//       printf("disp thred %d\n\r",j);
+        if(j >10 && j<15 ) putOnDisp("des",1);
+        else putOnDispNo(j,1);
+        j++;
+        thread_sleep_for(1000);
+    }
+}
+
+
+char * extract_string( char delimiter, char *ulazni_str, int n_str )
+{
+    int br_str=0;
+    char *ret_str=ulazni_str;
+    char* ptr = ulazni_str;
+
+    while(*ptr) {
+        if(*ptr == delimiter) {
+            *ptr = 0;
+            if( br_str == n_str )   return ret_str;
+            else {
+                br_str++;
+                ret_str = ptr + 1;
+            }
+        }
+        ptr++;
+    }
+    if( br_str == n_str )   return ret_str;
+    return NULL;
+}
+