bosko lekovic
nova proba
Diff: UdpToScom.cpp
- Revision:
- 2:45b351b4fc2a
- Child:
- 9:893843262a1f
diff -r e1bde4e82763 -r 45b351b4fc2a UdpToScom.cpp
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/UdpToScom.cpp Sun Apr 05 12:56:41 2020 +0000
@@ -0,0 +1,218 @@
+#include "mbed.h"
+#include "clubbing.h"
+#include "UdpToScom.h"
+#include "EthernetSetup.h"
+
+
+
+struct S_EthernetAddress_Remote
+/*{
+ char ip[16];
+ int port;
+}*/ s_EthAddRemote = {"192.168.1.14", 13000 }, *ps_ear = &s_EthAddRemote,
+ s_EthAddBroadcast = {"0.0.0.0", 13000 }, *ps_eab = &s_EthAddBroadcast;
+
+char lokaUdpPort[6] = "13000", localUdpPortFlash[6] = "65535";
+
+#define SerialTxPin PTC17
+#define SerialRxPin PTC16
+char scomBaud[7] = "9600", scomBaudFlash[7] = "200000";
+
+
+/* globalni pointeri*/
+
+
+EthernetInterface *gp_eth;
+
+UDPSocket *gp_udpSocket = NULL;
+Thread *gp_udpRxThread = NULL;
+
+Thread *gp_scomRxThread=NULL;
+UARTSerial *gp_scom=NULL;
+
+
+int get_baud( void )
+{
+ int a = atoi(scomBaudFlash), b = atoi(scomBaud), ret;
+ if( (a > 90) && (a < 100000) ) ret = a;
+ else if( (b > 90) && (b < 100000) ) ret = b;
+ else ret = 96/*00*/;
+ printf(" baud rates = %d %d final %d\n\r", a, b, ret );
+ return ret;
+}
+
+/***************** Predaja na UDP ****************************/
+void sendUdp( struct S_EthernetAddress_Remote *ps_ear, char *buffer, int val )
+{
+ if( gp_udpSocket )
+ {
+ printf(" UDPpaket ip=%s port=%d val=%d\n\r", ps_ear->ip, ps_ear->port, val);
+ gp_udpSocket->sendto(ps_ear->ip, ps_ear->port, (const uint8_t*)buffer, val);
+ }
+ else printf("UDPsocket == NULL\n\r");
+}
+
+/**************** Predaja na Serial Com ********************************/
+
+void sendScom( struct UARTSerial *p_scom, char *buffer, int val)
+{
+ if( p_scom )
+ {
+ int num;
+ if(val>0) num = p_scom->write( (const uint8_t*) buffer, val );
+ printf(" Poslan serial com paket od %d bajtova", num);
+ }
+ else printf("Serial com neinicijalizovan\n\r");
+}
+
+/************** Prijem na serial com i slanje na UDP *********************/
+
+void scomrx_fun( void )
+{
+
+ uint8_t readbuff[1500];
+ int totno=0;
+ int noreaded=0;
+// if(gp_scom) delete gp_scom;
+ gp_scom = new UARTSerial(SerialTxPin,SerialRxPin,get_baud()); //38400 za KSS
+
+ printf("Rx serial com initialised\n\r");
+
+ while( !(ThisThread::flags_get( ) & 1) )
+ {
+ if( gp_scom->readable() )
+ {
+ noreaded = gp_scom->read( (uint8_t *)(readbuff+totno), 1500);
+ totno += noreaded;
+ wait(0.01);
+ }
+ else if(totno)
+ {
+ printf("PRIJEM na rs232 com totno = %d \n\r", totno);
+ // if(readbuff[0] == 'q') {extern Thread udpBroadcast_thread; udpBroadcast_thread.terminate();}
+
+ if(readbuff[0] == 'c'){ extern void udpBroadcast_fun( void );Thread *th = new Thread; th->start( udpBroadcast_fun);}
+ if(readbuff[0] == 'r'){ extern void inic_1(void); extern PFV pfv; pfv = inic_1; }
+ if(readbuff[0] == 'q'){ if(gp_udpSocket)gp_udpSocket->close();gp_udpSocket=NULL; }
+ sendUdp( ps_ear, (char *)readbuff, totno);
+ totno = 0;
+ }
+ }
+ if(gp_scom) {delete gp_scom; gp_scom = NULL;}
+ printf(" Ugasen serial com Thread\n\r");
+}
+
+
+/******************* Broadcast thread **********************/
+Thread udpBroadcast_thread;
+void udpBroadcast_fun( void )
+{
+ while(true)
+ {
+ sendUdp( ps_eab, (char *)"test broadcast", 14);
+ wait(5);
+ }
+}
+
+/*************** Prijem na UDP socket i predaja na Serial com ***************/
+
+void udpRx_fun( void )
+{
+//int *p = (int*)pp;
+ nsapi_error_t err;
+
+ char inbuff[1500];
+
+ // if(gp_udpSocket == NULL)
+ {
+ gp_udpSocket = new UDPSocket;
+ printf("___novi UDP socket %x\n\r", gp_udpSocket);
+ if( (err = gp_udpSocket->open( gp_eth )) != NSAPI_ERROR_OK )
+ { printf(" greska otvaranja soketa %d \n\r", err); }
+ gp_udpSocket->bind(ps_ear->port);
+ gp_udpSocket->set_timeout(1000);
+ }
+ printf("UDPrx inicijalizovan \n\r");
+
+
+signed int n=0;
+ while( !(ThisThread::flags_get( ) & 1) )
+ {
+ SocketAddress sockAddr;
+ if( (n>=0) && gp_udpSocket )
+ {
+ int n = gp_udpSocket->recvfrom(&sockAddr, &inbuff, sizeof(inbuff));
+ if(n>0) sendScom( gp_scom, inbuff, n);//gp_scom->write( (const uint8_t*) inbuff, n );
+ else if(n==-3001) n = 0;
+ else break;
+ }
+ //else wait(0.1);
+ }
+
+ if(gp_udpSocket) { delete gp_udpSocket; gp_udpSocket = NULL;}
+ printf("udpSocket obrisan\n\r");
+ fflush(stdout);
+}
+
+
+
+void inic_1(void)
+{
+
+ printf("\n\r -------- REINICIJALIZACIJA ------------- \n\r");
+
+ /* Gasenje UDP threada */
+ if( gp_udpRxThread->get_state( ) && gp_udpRxThread->get_state( )<16 )
+ gp_udpRxThread->flags_set( 1 );
+ gp_udpRxThread->join( );
+ if(gp_udpRxThread) {delete gp_udpRxThread; gp_udpRxThread = NULL;}
+ printf("udp thread zavrsio\n\r");
+
+ /* gasenje serial com thread-a */
+ int st = gp_scomRxThread->get_state();
+ if( st && st<16 )gp_scomRxThread->flags_set(1);
+ gp_scomRxThread->join();
+ printf("ScomRx Thread upravo zavrsio\n\r");
+ if(gp_scomRxThread) { delete gp_scomRxThread; gp_scomRxThread = NULL;}
+
+ gp_eth->disconnect(); /* gasenje ethernta */
+
+ gp_eth = ethernet_setup( ); /*paljenje etherneta*/
+ if(gp_eth == NULL) printf("ethernet greska\n\r");
+ else printf("eth OK\n\r");
+
+ /* paljenje UDP thread-a */
+ gp_udpRxThread = new Thread( udpRx_fun );
+
+
+ /* paljenje serial com thread-a */
+ gp_scomRxThread = new Thread(scomrx_fun);
+
+
+//
+ fflush(stdout);
+
+}
+
+void init_EthToScom( void )
+{
+ gp_eth = ethernet_setup( );
+
+ if(gp_eth == NULL) printf("ethernet greska");
+ else printf("eth OK\n\r");
+
+
+ if(gp_scomRxThread) delete gp_scomRxThread;
+ gp_scomRxThread = new Thread(scomrx_fun);
+
+
+ /*
+ TCPSocket socket;
+ socket.open(ð);
+ socket.connect(
+ */
+
+
+ gp_udpRxThread = new Thread( udpRx_fun );
+
+}
\ No newline at end of file