VZTECH / Mbed 2 deprecated main_src

Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

clock.cpp@137:32dd35a6dbc9, 2015-11-24 (annotated)

Committer:
klauss
Date:
Tue Nov 24 14:06:22 2015 +0000
Revision:
137:32dd35a6dbc9
Parent:
135:2f4290590e51 
core source of the .bin (09/21/2015) in the field

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 122:480c44b0e205 1 #include "clock.h"
klauss 119:ee6a53069455 2
klauss 119:ee6a53069455 3 time_t current_time = 0;
klauss 119:ee6a53069455 4
klauss 119:ee6a53069455 5 UDPSocket clock_sock;
klauss 119:ee6a53069455 6
klauss 119:ee6a53069455 7 Endpoint clock_server;
klauss 119:ee6a53069455 8
klauss 119:ee6a53069455 9 Timer server_clock_timer;
klauss 119:ee6a53069455 10
klauss 132:05cd37f7e007 11 int
klauss 132:05cd37f7e007 12 request_clock_to_server ( void )
klauss 119:ee6a53069455 13 {
klauss 132:05cd37f7e007 14 char clock_msg [ TIME_MSG_SIZE ];
klauss 119:ee6a53069455 15
klauss 120:770f00554b1e 16 for ( register uint8_t i = 0; i < TIME_MSG_SIZE; i++ ) clock_msg [ i ] = 0x00;
klauss 120:770f00554b1e 17
klauss 120:770f00554b1e 18 clock_msg [ 0 ] = 0x23;
klauss 120:770f00554b1e 19
klauss 132:05cd37f7e007 20 int send = clock_sock.sendTo ( clock_server, clock_msg, TIME_MSG_SIZE );
klauss 119:ee6a53069455 21
klauss 132:05cd37f7e007 22 if ( debug_clock ) vz_debug ("::%d::%s::%s::%d::", send, clock_msg, clock_server.get_address (), clock_server.get_port () );
klauss 119:ee6a53069455 23
klauss 132:05cd37f7e007 24 if ( send not_eq TIME_MSG_SIZE )
klauss 119:ee6a53069455 25 {
klauss 132:05cd37f7e007 26 if ( debug_reconnect ) vz_debug ("Reconnect clock request" );
klauss 132:05cd37f7e007 27 int clock_sock_reconnect_ret = clock_sock_reconnect ();
klauss 132:05cd37f7e007 28
klauss 132:05cd37f7e007 29 if ( debug_reconnect ) vz_debug ("Valor de retorno no reconnect :: %d", clock_sock_reconnect_ret );
klauss 132:05cd37f7e007 30
klauss 132:05cd37f7e007 31 miss_clock_send_pkg ++;
klauss 119:ee6a53069455 32 }
klauss 132:05cd37f7e007 33
klauss 132:05cd37f7e007 34 if ( debug_clock ) vz_debug ("send :: %d", send );
klauss 119:ee6a53069455 35
klauss 119:ee6a53069455 36 return ( send );
klauss 119:ee6a53069455 37 }
klauss 119:ee6a53069455 38
klauss 119:ee6a53069455 39 int check_clock ( void )
klauss 119:ee6a53069455 40 {
klauss 119:ee6a53069455 41 if( server_clock_timer.read() > EXTERNAL_TIME_REQUEST_WAIT_SECONDS )
klauss 119:ee6a53069455 42 {
klauss 119:ee6a53069455 43 server_clock_timer.reset();
klauss 119:ee6a53069455 44 return request_clock_to_server ();
klauss 119:ee6a53069455 45 }
klauss 119:ee6a53069455 46 else
klauss 119:ee6a53069455 47 {
klauss 119:ee6a53069455 48 // nro arbitrario maior que strlen( request_time )
klauss 119:ee6a53069455 49 return 0x30;
klauss 119:ee6a53069455 50 }
klauss 119:ee6a53069455 51 }
klauss 119:ee6a53069455 52
klauss 119:ee6a53069455 53 int update_clock ( void )
klauss 119:ee6a53069455 54 {
klauss 120:770f00554b1e 55
klauss 120:770f00554b1e 56 char time_msg[ TIME_MSG_SIZE ];
klauss 120:770f00554b1e 57
klauss 119:ee6a53069455 58 Endpoint local_clock_server;
klauss 119:ee6a53069455 59
klauss 121:ee02790d00b7 60 int time_msg_rcv = clock_sock.receiveFrom ( local_clock_server, time_msg, sizeof( time_msg ) );
klauss 119:ee6a53069455 61
klauss 119:ee6a53069455 62 if( time_msg_rcv == -1 )
klauss 119:ee6a53069455 63 {
klauss 132:05cd37f7e007 64 if( debug_reconnect ) vz_printf ("Reconnect clock socket");
klauss 119:ee6a53069455 65 clock_sock_reconnect ();
klauss 120:770f00554b1e 66 } else {
klauss 120:770f00554b1e 67 if ( time_msg [ 0 ] != 0x24 )
klauss 120:770f00554b1e 68 {
klauss 132:05cd37f7e007 69 vz_debug ("Error: time_msg [ 0 ] != 0x24");
klauss 120:770f00554b1e 70 return time_msg [ 0 ];
klauss 120:770f00554b1e 71 } else if ( time_msg [ 1 ] == 0x00 )
klauss 120:770f00554b1e 72 {
klauss 132:05cd37f7e007 73 vz_debug ("Error: time_msg [ 0 ] == 0x00");
klauss 120:770f00554b1e 74 return time_msg [ 1 ];
klauss 120:770f00554b1e 75 } else if ( time_msg [ 1 ] > 0x0f )
klauss 120:770f00554b1e 76 {
klauss 132:05cd37f7e007 77 vz_debug ("Error: time_msg [ 0 ] > 0x0f");
klauss 120:770f00554b1e 78 return time_msg [ 1 ];
klauss 120:770f00554b1e 79 }
klauss 119:ee6a53069455 80 }
klauss 119:ee6a53069455 81
klauss 120:770f00554b1e 82 time_t local_current_time = 0;
klauss 120:770f00554b1e 83 local_current_time = 0;
klauss 119:ee6a53069455 84
klauss 120:770f00554b1e 85 local_current_time |= ( ( uint32_t ) time_msg [ 40 ] ) << 24;
klauss 120:770f00554b1e 86 local_current_time |= ( ( uint32_t ) time_msg [ 41 ] ) << 16;
klauss 120:770f00554b1e 87 local_current_time |= ( ( uint32_t ) time_msg [ 42 ] ) << 8;
klauss 120:770f00554b1e 88 local_current_time |= ( ( uint32_t ) time_msg [ 43 ] );
klauss 120:770f00554b1e 89 /*
klauss 120:770f00554b1e 90 Como o valor recebido nos bytes [40 41 42 43] correspondem aos segundos decorridos desde 1/1/1900,
klauss 120:770f00554b1e 91 e como queremos trabalhar com unixtime, convertemos fazendo a subtracao de 70 anos = 2208988800
klauss 120:770f00554b1e 92 */
klauss 120:770f00554b1e 93 local_current_time -= 2208988800;
klauss 120:770f00554b1e 94
klauss 120:770f00554b1e 95 int diff_time = ( local_current_time > current_time ) ? local_current_time - current_time : current_time - local_current_time;
klauss 120:770f00554b1e 96
klauss 120:770f00554b1e 97 if ( diff_time > 2 ) current_time = local_current_time;
klauss 120:770f00554b1e 98
klauss 132:05cd37f7e007 99 if ( debug_clock ) vz_debug ("Clock.rcv ( %d ), diff [ %d ] ", local_current_time, diff_time );
klauss 119:ee6a53069455 100
klauss 121:ee02790d00b7 101 return ( local_current_time - current_time );
klauss 119:ee6a53069455 102 }
klauss 119:ee6a53069455 103
klauss 119:ee6a53069455 104 int init_clock ( void )
klauss 119:ee6a53069455 105 {
klauss 121:ee02790d00b7 106 char server_ip [ 16 ];
klauss 122:480c44b0e205 107
klauss 132:05cd37f7e007 108 cm -> get_clock_server_ip ( server_ip );
klauss 132:05cd37f7e007 109
klauss 132:05cd37f7e007 110 int clock_server_set_address_ret = clock_server.set_address ( server_ip, CLOCK_SERVER_PORT );
klauss 122:480c44b0e205 111
klauss 132:05cd37f7e007 112 if ( debug_clock ) vz_debug ("clock_server_set_address_ret :: %d", clock_server_set_address_ret );
klauss 122:480c44b0e205 113
klauss 132:05cd37f7e007 114 int clock_sock_bind_ret = clock_sock.bind ( CLOCK_HEADER_PORT );
klauss 119:ee6a53069455 115
klauss 132:05cd37f7e007 116 clock_sock.set_blocking ( false, 0 );
klauss 119:ee6a53069455 117
klauss 132:05cd37f7e007 118 if ( debug_clock ) vz_debug ("clock_sock_bind_ret ::%d", clock_sock_bind_ret );
klauss 119:ee6a53069455 119
klauss 132:05cd37f7e007 120 server_clock_timer.start ();
klauss 119:ee6a53069455 121
klauss 119:ee6a53069455 122 request_clock_to_server ();
klauss 119:ee6a53069455 123
klauss 119:ee6a53069455 124 return ( clock_server_set_address_ret | clock_sock_bind_ret );
klauss 119:ee6a53069455 125 }
klauss 119:ee6a53069455 126
klauss 132:05cd37f7e007 127 int
klauss 132:05cd37f7e007 128 clock_sock_reconnect ( void )
klauss 119:ee6a53069455 129 {
klauss 119:ee6a53069455 130 clock_sock.close ();
klauss 119:ee6a53069455 131
klauss 132:05cd37f7e007 132 int clock_sock_bind_ret = clock_sock.bind ( CLOCK_HEADER_PORT );
klauss 119:ee6a53069455 133
klauss 132:05cd37f7e007 134 clock_sock.set_blocking ( false, 0 );
klauss 119:ee6a53069455 135
klauss 119:ee6a53069455 136 return ( clock_sock_bind_ret );
klauss 119:ee6a53069455 137 }
klauss 119:ee6a53069455 138
klauss 119:ee6a53069455 139 int show_clock ( void )
klauss 119:ee6a53069455 140 {
klauss 119:ee6a53069455 141 char buffer[ 512 ];
klauss 119:ee6a53069455 142 struct tm * result_tm;
klauss 119:ee6a53069455 143 if ( sizeof( time_t ) != sizeof( long ) )
klauss 119:ee6a53069455 144 {
klauss 132:05cd37f7e007 145 vz_printf ("sizeof( time_t ) : %lu -- sizeof( long int ) : %lu\n", sizeof( time_t ), sizeof( long ) );
klauss 119:ee6a53069455 146 }
klauss 119:ee6a53069455 147
klauss 119:ee6a53069455 148 int filled = snprintf( buffer, 512, "current_time : %lu\tclock() : ", current_time );
klauss 119:ee6a53069455 149 int available_bytes = 512 - filled - 1;
klauss 119:ee6a53069455 150
klauss 119:ee6a53069455 151 if ( current_time != 0 )
klauss 119:ee6a53069455 152 {
klauss 119:ee6a53069455 153 result_tm = localtime( ( const time_t *)&current_time );
klauss 119:ee6a53069455 154 if ( result_tm )
klauss 119:ee6a53069455 155 {
klauss 119:ee6a53069455 156 char formated_time[ 16 ];
klauss 119:ee6a53069455 157
klauss 119:ee6a53069455 158 /* Correcao "manual" do (GMT -3:00) */
klauss 119:ee6a53069455 159 result_tm->tm_hour -= 3;
klauss 119:ee6a53069455 160 if ( result_tm->tm_hour < 0 ) result_tm->tm_hour = 24 + result_tm->tm_hour;
klauss 119:ee6a53069455 161
klauss 135:2f4290590e51 162 strftime ( formated_time, sizeof( formated_time ), "%Y%m%d%H%M%S", result_tm );
klauss 119:ee6a53069455 163
klauss 119:ee6a53069455 164 strncat ( buffer, formated_time, available_bytes );
klauss 119:ee6a53069455 165 }
klauss 119:ee6a53069455 166 }
klauss 119:ee6a53069455 167 else
klauss 119:ee6a53069455 168 {
klauss 119:ee6a53069455 169 strncat ( buffer, "???", available_bytes );
klauss 119:ee6a53069455 170 }
klauss 119:ee6a53069455 171
klauss 132:05cd37f7e007 172 vz_printf ( "%s", buffer );
klauss 119:ee6a53069455 173
klauss 121:ee02790d00b7 174 return ( strlen ( buffer ) );
klauss 119:ee6a53069455 175 }