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@131:938ab88facae, 2015-07-21 (annotated)

Committer:
klauss
Date:
Tue Jul 21 20:03:35 2015 +0000
Revision:
131:938ab88facae
Parent:
122:480c44b0e205
Child:
132:05cd37f7e007
pequenas altera??es na mensagem de "help"

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