bosko lekovic / Mbed OS IO_board_K22

K22 processor

main.cpp@8:5a96bfb6b6f9, 2021-03-21 (annotated)

Committer:
bosko001
Date:
Sun Mar 21 18:20:52 2021 +0100
Revision:
8:5a96bfb6b6f9
Parent:
6:12b2660d7dff
Child:
9:a4360a7713f5
novi kod

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bosko001 0:c06c791ca345 1 /* mbed Microcontroller Library
bosko001 0:c06c791ca345 2 * Copyright (c) 2019 ARM Limited
bosko001 0:c06c791ca345 3 * SPDX-License-Identifier: Apache-2.0
bosko001 0:c06c791ca345 4 */
bosko001 0:c06c791ca345 5
bosko001 0:c06c791ca345 6 #include "mbed.h"
bosko001 0:c06c791ca345 7 #include "platform/mbed_thread.h"
bosko001 6:12b2660d7dff 8 #include <vector>
bosko001 0:c06c791ca345 9
bosko001 6:12b2660d7dff 10 #include "Pinovi.h"
bosko001 6:12b2660d7dff 11 // #include "IOspiLed.h"
bosko001 6:12b2660d7dff 12 #include "ledControl.h"
bosko001 6:12b2660d7dff 13
bosko001 6:12b2660d7dff 14
bosko001 6:12b2660d7dff 15 // #include "IOgpiospi.h"
bosko001 6:12b2660d7dff 16 // #include "IOspitelegram.h"
bosko001 6:12b2660d7dff 17 #include "IOspiprotokol.h"
bosko001 6:12b2660d7dff 18
bosko001 6:12b2660d7dff 19 #include "ZeroCrossing.h"
bosko001 6:12b2660d7dff 20 #include "IOzcControl.h"
bosko001 6:12b2660d7dff 21
bosko001 6:12b2660d7dff 22
bosko001 6:12b2660d7dff 23 extern vector< S_logTelegram> s_log;
bosko001 0:c06c791ca345 24
bosko001 8:5a96bfb6b6f9 25
bosko001 8:5a96bfb6b6f9 26
bosko001 8:5a96bfb6b6f9 27
bosko001 0:c06c791ca345 28 // Blinking rate in milliseconds
bosko001 0:c06c791ca345 29 #define BLINKING_RATE_MS 200
bosko001 0:c06c791ca345 30
bosko001 6:12b2660d7dff 31 DigitalOut ioTest(IO_TEST,0);
bosko001 0:c06c791ca345 32
bosko001 6:12b2660d7dff 33 DigitalOut testPin(PTE24, 0 );
bosko001 6:12b2660d7dff 34
bosko001 6:12b2660d7dff 35
bosko001 6:12b2660d7dff 36 char verzija = 5;
bosko001 0:c06c791ca345 37
bosko001 0:c06c791ca345 38
bosko001 0:c06c791ca345 39 DigitalIn b2(SW2);
bosko001 0:c06c791ca345 40
bosko001 6:12b2660d7dff 41 DigitalOut ledB(LED3,1);
bosko001 0:c06c791ca345 42
bosko001 0:c06c791ca345 43
bosko001 3:71278c5b7c67 44
bosko001 0:c06c791ca345 45
bosko001 6:12b2660d7dff 46 class C_data c_data;
bosko001 6:12b2660d7dff 47
bosko001 6:12b2660d7dff 48
bosko001 6:12b2660d7dff 49 C_ledControl c_ledControl(&c_data);//( &c_ledLight);
bosko001 6:12b2660d7dff 50
bosko001 6:12b2660d7dff 51 C_spiProtokol c_spiProtokol( &c_data, &c_ledControl );
bosko001 6:12b2660d7dff 52
bosko001 6:12b2660d7dff 53 C_zeroCrossing c_zeroCrossing( &c_data);
bosko001 6:12b2660d7dff 54 C_zeroCrossing& rc_zc = c_zeroCrossing;
bosko001 6:12b2660d7dff 55
bosko001 6:12b2660d7dff 56 C_zcControl c_zcControl( &c_zeroCrossing, &c_spiProtokol);
bosko001 6:12b2660d7dff 57
bosko001 6:12b2660d7dff 58 //DigitalOut pola( PTB20, 0); // test zero crossing ivica
bosko001 6:12b2660d7dff 59
bosko001 6:12b2660d7dff 60
bosko001 6:12b2660d7dff 61 Ticker test_RasaLed;
bosko001 6:12b2660d7dff 62 DigitalOut RasaLed(PTE0,1);
bosko001 6:12b2660d7dff 63
bosko001 6:12b2660d7dff 64 long t; int tz;
bosko001 6:12b2660d7dff 65 int v1, v2, v3, v4,v5,v6,f=0;
bosko001 6:12b2660d7dff 66 int time_delay = 0, time_flag=0;
bosko001 0:c06c791ca345 67
bosko001 0:c06c791ca345 68 int main()
bosko001 0:c06c791ca345 69 {
bosko001 6:12b2660d7dff 70
bosko001 0:c06c791ca345 71 // Initialise the digital pin LED1 as an output
bosko001 6:12b2660d7dff 72
bosko001 4:fce988d27938 73 printf("\n\n\r ____________ POCETAK IOboard_______________\n\r");
bosko001 0:c06c791ca345 74
bosko001 6:12b2660d7dff 75 s_log.resize(1000);
bosko001 6:12b2660d7dff 76 s_log.clear();
bosko001 6:12b2660d7dff 77
bosko001 6:12b2660d7dff 78 printf( " capacity %d max_size %d size %d\n\r", s_log.capacity(), s_log.max_size(), s_log.size());
bosko001 6:12b2660d7dff 79 test_RasaLed.attach_us([=]{ RasaLed = !RasaLed;}, 500000 );
bosko001 6:12b2660d7dff 80
bosko001 6:12b2660d7dff 81 /* postavljanje funkcija za komande i indikaciju sinhrono sa zero crossing-om */
bosko001 6:12b2660d7dff 82
bosko001 6:12b2660d7dff 83
bosko001 6:12b2660d7dff 84 c_zeroCrossing.set_ontimeONfun( []()
bosko001 6:12b2660d7dff 85 {
bosko001 6:12b2660d7dff 86 // testPin =! testPin;
bosko001 6:12b2660d7dff 87 rc_zc.set_portOut( c_data.get_command() );//
bosko001 6:12b2660d7dff 88 if( c_data.get_newcommand_flag() == true) { time_delay = 1; t = (long)Kernel::get_ms_count(); }// vreme = time_delay * 20ms
bosko001 6:12b2660d7dff 89 else if(time_delay) { time_delay--; if( time_delay == 0 ) time_flag = 1; }
bosko001 6:12b2660d7dff 90 else { c_data.set_messagge(); c_data.set_realIndication();}
bosko001 6:12b2660d7dff 91 }
bosko001 6:12b2660d7dff 92 );
bosko001 6:12b2660d7dff 93 c_zeroCrossing.set_ontimeOFFfun( [](){ } );
bosko001 6:12b2660d7dff 94 c_zeroCrossing.set_postponeONfun( []() // minimum mreze - rad sa indikacijama ispravnosti sijalica
bosko001 6:12b2660d7dff 95 {
bosko001 6:12b2660d7dff 96 if(time_delay == 0 && (c_data.check_newcommand_flag()== false) )
bosko001 6:12b2660d7dff 97 {
bosko001 6:12b2660d7dff 98 char p1 = rc_zc.get_portInMin(); // dva ocitavanja porta
bosko001 6:12b2660d7dff 99 wait_us(10);
bosko001 6:12b2660d7dff 100 char p2 = rc_zc.get_portInMin();
bosko001 6:12b2660d7dff 101 p1 &= p2;
bosko001 6:12b2660d7dff 102 c_data.set_pMin( p1 );
bosko001 6:12b2660d7dff 103 c_data.set_indication();
bosko001 6:12b2660d7dff 104 c_data.set_corectness();
bosko001 6:12b2660d7dff 105 c_data.set_realIndication();
bosko001 4:fce988d27938 106
bosko001 6:12b2660d7dff 107 // ledB =!ledB;
bosko001 6:12b2660d7dff 108 // static int i=0;
bosko001 6:12b2660d7dff 109 // if(i++ > 100) { i = 0; f = 1;
bosko001 6:12b2660d7dff 110 // v1 = c_data.pMin;
bosko001 6:12b2660d7dff 111 // v2 = c_data.get_command();
bosko001 6:12b2660d7dff 112 // v3 = c_data.get_indication();
bosko001 6:12b2660d7dff 113 // }
bosko001 6:12b2660d7dff 114 }
bosko001 6:12b2660d7dff 115 else c_data.clear_pMin();
bosko001 6:12b2660d7dff 116 }
bosko001 6:12b2660d7dff 117 );
bosko001 6:12b2660d7dff 118 c_zeroCrossing.set_postponeOFFfun( []() // maximum mreze - rad sa neispravnim naponom - misem
bosko001 6:12b2660d7dff 119 {
bosko001 6:12b2660d7dff 120 static int i=0, j=0;
bosko001 6:12b2660d7dff 121 if(time_delay == 0 && (c_data.check_newcommand_flag()== false))
bosko001 6:12b2660d7dff 122 {
bosko001 6:12b2660d7dff 123 ledB =!ledB;
bosko001 6:12b2660d7dff 124 char p1 = rc_zc.get_portInMax(); // dva ocitavanja porta
bosko001 6:12b2660d7dff 125 wait_us(10);
bosko001 6:12b2660d7dff 126 char p2 = rc_zc.get_portInMax();
bosko001 6:12b2660d7dff 127 p1 |= p2;
bosko001 6:12b2660d7dff 128 v1 = c_data.set_pMax( v4 = p1 );
bosko001 6:12b2660d7dff 129 c_data.set_faultVoltage();
bosko001 6:12b2660d7dff 130 v2 = c_data.get_command();
bosko001 6:12b2660d7dff 131 v3 = c_data.get_faultVoltage();
bosko001 6:12b2660d7dff 132
bosko001 6:12b2660d7dff 133 if(time_flag)
bosko001 6:12b2660d7dff 134 {
bosko001 6:12b2660d7dff 135 testPin =! testPin;
bosko001 6:12b2660d7dff 136 f = 1; time_flag--;
bosko001 6:12b2660d7dff 137 v1 = c_data.pMax;
bosko001 6:12b2660d7dff 138 v6 = (long)Kernel::get_ms_count()-t;
bosko001 6:12b2660d7dff 139 }
bosko001 6:12b2660d7dff 140 }
bosko001 6:12b2660d7dff 141 else c_data.clear_pMax();
bosko001 6:12b2660d7dff 142
bosko001 6:12b2660d7dff 143 } );
bosko001 6:12b2660d7dff 144
bosko001 0:c06c791ca345 145
bosko001 0:c06c791ca345 146 int b = b2;
bosko001 0:c06c791ca345 147
bosko001 6:12b2660d7dff 148 /* konzolu napraciti kao klasu koja nasledjuje C_thread klasu */
bosko001 6:12b2660d7dff 149 extern void consolafun( void );
bosko001 6:12b2660d7dff 150 Thread th_consola;
bosko001 6:12b2660d7dff 151 th_consola.start( consolafun);
bosko001 6:12b2660d7dff 152
bosko001 6:12b2660d7dff 153 /* cekanje da se procita prva ispravna adresa sa dip switch-a */
bosko001 6:12b2660d7dff 154 do { ThisThread::sleep_for(10ms);;c_spiProtokol.inic_address( ); }
bosko001 6:12b2660d7dff 155 while ( c_data.get_address() == 0 );
bosko001 6:12b2660d7dff 156 printf(" adresa je = %d\n\r", c_data.get_address());
bosko001 6:12b2660d7dff 157
bosko001 6:12b2660d7dff 158 // postavljanje sopstvene adrese i prikaz na ledovima
bosko001 6:12b2660d7dff 159 c_spiProtokol.set_myAddress(c_data.get_address());
bosko001 6:12b2660d7dff 160 c_ledControl.set_colorTemplate_Green();
bosko001 6:12b2660d7dff 161 c_ledControl.set_ledView(adresa);
bosko001 6:12b2660d7dff 162
bosko001 4:fce988d27938 163
bosko001 0:c06c791ca345 164 while (true)
bosko001 0:c06c791ca345 165 {
bosko001 0:c06c791ca345 166
bosko001 6:12b2660d7dff 167 /* if(f==1)
bosko001 6:12b2660d7dff 168 {
bosko001 6:12b2660d7dff 169 f=0;
bosko001 6:12b2660d7dff 170 printf( "det = %x %x %x %x %d vreme = %d %d\n\r", v1, v2, v3, v4, v5, v6, t);
bosko001 6:12b2660d7dff 171 }
bosko001 6:12b2660d7dff 172 */
bosko001 4:fce988d27938 173
bosko001 0:c06c791ca345 174 if( b!= b2)
bosko001 0:c06c791ca345 175 {
bosko001 0:c06c791ca345 176 b = b2;
bosko001 6:12b2660d7dff 177 if( b ) { ledB = 1;}
bosko001 6:12b2660d7dff 178 else { ledB = 0; //printf( " bitCount = %d, byteCount = %d\n\r", c_spiProtokol.get_bitCount(), c_spiProtokol.get_byteCount());
bosko001 6:12b2660d7dff 179
bosko001 6:12b2660d7dff 180 printf( " zerocrossing timer on = %d off = %d \n\r", c_zeroCrossing.get_zcTimeON(), c_zeroCrossing.get_zcTimeOFF());
bosko001 6:12b2660d7dff 181 // printf(" port in %x\n\r", rc_zc.s_portinMin.get_port() );
bosko001 6:12b2660d7dff 182 printf(" adresa je = %d\n\r", c_data.get_address());
bosko001 6:12b2660d7dff 183 }
bosko001 0:c06c791ca345 184 }
bosko001 6:12b2660d7dff 185
bosko001 6:12b2660d7dff 186 c_spiProtokol.spi_monitor();
bosko001 0:c06c791ca345 187
bosko001 0:c06c791ca345 188
bosko001 0:c06c791ca345 189 thread_sleep_for(BLINKING_RATE_MS);
bosko001 0:c06c791ca345 190 }
bosko001 0:c06c791ca345 191 }
bosko001 0:c06c791ca345 192
bosko001 0:c06c791ca345 193
bosko001 0:c06c791ca345 194
bosko001 0:c06c791ca345 195 void consolafun( void )
bosko001 0:c06c791ca345 196 {
bosko001 0:c06c791ca345 197 while( true )
bosko001 0:c06c791ca345 198 {
bosko001 6:12b2660d7dff 199
bosko001 0:c06c791ca345 200 char uc = getchar( );
bosko001 0:c06c791ca345 201 switch( (unsigned char) uc )
bosko001 0:c06c791ca345 202 {
bosko001 0:c06c791ca345 203 case 'r': case 'R':
bosko001 0:c06c791ca345 204
bosko001 0:c06c791ca345 205 printf("\n\rcitanje registra, unesi broj:\n\r");
bosko001 0:c06c791ca345 206 int r;
bosko001 0:c06c791ca345 207 scanf("%x", &r);
bosko001 1:1052d6227111 208 // printf( "\n\rregistar %x ima vrednost %x\n\r", r, readMiWiReg(r));
bosko001 0:c06c791ca345 209
bosko001 0:c06c791ca345 210 break;
bosko001 0:c06c791ca345 211 case 'w': case 'W':
bosko001 0:c06c791ca345 212 {
bosko001 0:c06c791ca345 213 printf("\n\rupis registra, unesi broj registra:");
bosko001 0:c06c791ca345 214 int r;
bosko001 0:c06c791ca345 215 scanf("%x", &r);
bosko001 0:c06c791ca345 216 printf( " %x", r );
bosko001 0:c06c791ca345 217 printf("\n\runesi vrednost registra:");
bosko001 0:c06c791ca345 218 int v;
bosko001 0:c06c791ca345 219 scanf("%x", &v);
bosko001 0:c06c791ca345 220 printf( " %x", v );
bosko001 1:1052d6227111 221 // printf( "\n\rregistar %x ima vrednost %x\n\r", r, readMiWiReg(r));
bosko001 0:c06c791ca345 222 }
bosko001 0:c06c791ca345 223 break;
bosko001 4:fce988d27938 224 case 's': case 'S':
bosko001 6:12b2660d7dff 225 // set_shiftspi_signal( );
bosko001 4:fce988d27938 226 break;
bosko001 4:fce988d27938 227
bosko001 6:12b2660d7dff 228 case 'c':
bosko001 6:12b2660d7dff 229 s_log.clear();
bosko001 6:12b2660d7dff 230 //break;
bosko001 6:12b2660d7dff 231 case 'l':
bosko001 6:12b2660d7dff 232 printf( " capacity %d max_size %d size %d\n\r", s_log.capacity(), s_log.max_size(), s_log.size());
bosko001 6:12b2660d7dff 233 break;
bosko001 6:12b2660d7dff 234 case 'p':
bosko001 6:12b2660d7dff 235 int i=1;
bosko001 6:12b2660d7dff 236 if(s_log.size())
bosko001 6:12b2660d7dff 237 {
bosko001 6:12b2660d7dff 238 for( auto it = s_log.end()-1; it != s_log.begin(); it--)
bosko001 6:12b2660d7dff 239 printf( "%3d %s\n\r", i++, (*it).poruka);
bosko001 6:12b2660d7dff 240 auto it = s_log.begin();
bosko001 6:12b2660d7dff 241 printf( "%3d %s\n\r", i++, (*it).poruka );
bosko001 6:12b2660d7dff 242 }
bosko001 6:12b2660d7dff 243 break;
bosko001 0:c06c791ca345 244 }
bosko001 3:71278c5b7c67 245 ThisThread::yield();
bosko001 3:71278c5b7c67 246 thread_sleep_for(100);
bosko001 0:c06c791ca345 247 }
bosko001 0:c06c791ca345 248 }