bosko lekovic
K22 processor
Diff: main.cpp
- Revision:
- 6:12b2660d7dff
- Parent:
- 4:fce988d27938
- Child:
- 8:5a96bfb6b6f9
--- a/main.cpp Thu Sep 10 22:22:54 2020 +0200
+++ b/main.cpp Sun Jan 17 20:03:16 2021 +0100
@@ -5,61 +5,182 @@
#include "mbed.h"
#include "platform/mbed_thread.h"
+#include <vector>
-#include "IOspiLed.h"
-#include "IOgpiospi.h"
-#include "IOprotokol.h"
+#include "Pinovi.h"
+// #include "IOspiLed.h"
+#include "ledControl.h"
+
+
+// #include "IOgpiospi.h"
+// #include "IOspitelegram.h"
+#include "IOspiprotokol.h"
+
+#include "ZeroCrossing.h"
+#include "IOzcControl.h"
+
+
+extern vector< S_logTelegram> s_log;
// Blinking rate in milliseconds
#define BLINKING_RATE_MS 200
+DigitalOut ioTest(IO_TEST,0);
+DigitalOut testPin(PTE24, 0 );
+
+
+char verzija = 5;
DigitalIn b2(SW2);
+DigitalOut ledB(LED3,1);
-void consolafun( void );
-Thread th_consola;
+class C_data c_data;
+
+
+C_ledControl c_ledControl(&c_data);//( &c_ledLight);
+
+C_spiProtokol c_spiProtokol( &c_data, &c_ledControl );
+
+C_zeroCrossing c_zeroCrossing( &c_data);
+C_zeroCrossing& rc_zc = c_zeroCrossing;
+
+C_zcControl c_zcControl( &c_zeroCrossing, &c_spiProtokol);
+
+//DigitalOut pola( PTB20, 0); // test zero crossing ivica
+
+
+Ticker test_RasaLed;
+DigitalOut RasaLed(PTE0,1);
+
+long t; int tz;
+int v1, v2, v3, v4,v5,v6,f=0;
+int time_delay = 0, time_flag=0;
int main()
{
+
// Initialise the digital pin LED1 as an output
+
printf("\n\n\r ____________ POCETAK IOboard_______________\n\r");
- inic_IOspiLed( );
- // inicIOboard_spi( );
- inicIO_gpiospi( );
- inicIO_protokol( );
+s_log.resize(1000);
+s_log.clear();
+
+printf( " capacity %d max_size %d size %d\n\r", s_log.capacity(), s_log.max_size(), s_log.size());
+test_RasaLed.attach_us([=]{ RasaLed = !RasaLed;}, 500000 );
+
+/* postavljanje funkcija za komande i indikaciju sinhrono sa zero crossing-om */
+
+
+ c_zeroCrossing.set_ontimeONfun( []()
+ {
+ // testPin =! testPin;
+ rc_zc.set_portOut( c_data.get_command() );//
+ if( c_data.get_newcommand_flag() == true) { time_delay = 1; t = (long)Kernel::get_ms_count(); }// vreme = time_delay * 20ms
+ else if(time_delay) { time_delay--; if( time_delay == 0 ) time_flag = 1; }
+ else { c_data.set_messagge(); c_data.set_realIndication();}
+ }
+ );
+ c_zeroCrossing.set_ontimeOFFfun( [](){ } );
+ c_zeroCrossing.set_postponeONfun( []() // minimum mreze - rad sa indikacijama ispravnosti sijalica
+ {
+ if(time_delay == 0 && (c_data.check_newcommand_flag()== false) )
+ {
+ char p1 = rc_zc.get_portInMin(); // dva ocitavanja porta
+ wait_us(10);
+ char p2 = rc_zc.get_portInMin();
+ p1 &= p2;
+ c_data.set_pMin( p1 );
+ c_data.set_indication();
+ c_data.set_corectness();
+ c_data.set_realIndication();
- DigitalOut ledB(LED3,1);
+ // ledB =!ledB;
+ // static int i=0;
+ // if(i++ > 100) { i = 0; f = 1;
+ // v1 = c_data.pMin;
+ // v2 = c_data.get_command();
+ // v3 = c_data.get_indication();
+ // }
+ }
+ else c_data.clear_pMin();
+ }
+ );
+ c_zeroCrossing.set_postponeOFFfun( []() // maximum mreze - rad sa neispravnim naponom - misem
+ {
+ static int i=0, j=0;
+ if(time_delay == 0 && (c_data.check_newcommand_flag()== false))
+ {
+ ledB =!ledB;
+ char p1 = rc_zc.get_portInMax(); // dva ocitavanja porta
+ wait_us(10);
+ char p2 = rc_zc.get_portInMax();
+ p1 |= p2;
+ v1 = c_data.set_pMax( v4 = p1 );
+ c_data.set_faultVoltage();
+ v2 = c_data.get_command();
+ v3 = c_data.get_faultVoltage();
+
+ if(time_flag)
+ {
+testPin =! testPin;
+ f = 1; time_flag--;
+ v1 = c_data.pMax;
+ v6 = (long)Kernel::get_ms_count()-t;
+ }
+ }
+ else c_data.clear_pMax();
+
+ } );
+
int b = b2;
- th_consola.start( consolafun);
+ /* konzolu napraciti kao klasu koja nasledjuje C_thread klasu */
+ extern void consolafun( void );
+ Thread th_consola;
+ th_consola.start( consolafun);
+
+ /* cekanje da se procita prva ispravna adresa sa dip switch-a */
+ do { ThisThread::sleep_for(10ms);;c_spiProtokol.inic_address( ); }
+ while ( c_data.get_address() == 0 );
+ printf(" adresa je = %d\n\r", c_data.get_address());
+
+ // postavljanje sopstvene adrese i prikaz na ledovima
+ c_spiProtokol.set_myAddress(c_data.get_address());
+ c_ledControl.set_colorTemplate_Green();
+ c_ledControl.set_ledView(adresa);
+
while (true)
{
- {
-
- spiLed_mainfun();
+/* if(f==1)
+ {
+ f=0;
+ printf( "det = %x %x %x %x %d vreme = %d %d\n\r", v1, v2, v3, v4, v5, v6, t);
+ }
+ */
if( b!= b2)
{
b = b2;
- if( b ) { /*ledB = 1;*/}
- else { /*ledB = 0;*/ static char c = 0; /*writeIOspiData( 0xa0, c++ );*/
- // transIOspiData( 1, 0xa, c++ );
- }
+ if( b ) { ledB = 1;}
+ else { ledB = 0; //printf( " bitCount = %d, byteCount = %d\n\r", c_spiProtokol.get_bitCount(), c_spiProtokol.get_byteCount());
+
+ printf( " zerocrossing timer on = %d off = %d \n\r", c_zeroCrossing.get_zcTimeON(), c_zeroCrossing.get_zcTimeOFF());
+ // printf(" port in %x\n\r", rc_zc.s_portinMin.get_port() );
+ printf(" adresa je = %d\n\r", c_data.get_address());
+ }
}
- ThisThread::yield();
-
- }
-
+
+ c_spiProtokol.spi_monitor();
thread_sleep_for(BLINKING_RATE_MS);
@@ -68,12 +189,11 @@
-
void consolafun( void )
{
while( true )
{
-
+
char uc = getchar( );
switch( (unsigned char) uc )
{
@@ -99,9 +219,25 @@
}
break;
case 's': case 'S':
- set_shiftspi_signal( );
+ // set_shiftspi_signal( );
break;
+ case 'c':
+ s_log.clear();
+ //break;
+ case 'l':
+ printf( " capacity %d max_size %d size %d\n\r", s_log.capacity(), s_log.max_size(), s_log.size());
+ break;
+ case 'p':
+ int i=1;
+ if(s_log.size())
+ {
+ for( auto it = s_log.end()-1; it != s_log.begin(); it--)
+ printf( "%3d %s\n\r", i++, (*it).poruka);
+ auto it = s_log.begin();
+ printf( "%3d %s\n\r", i++, (*it).poruka );
+ }
+ break;
}
ThisThread::yield();
thread_sleep_for(100);