Modularizando o src
Dependencies: EALib EthernetInterface_vz mbed-rtos mbed
Fork of header_main_colinas_V0-20-09-14 by
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?
User | Revision | Line number | New 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 *)¤t_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 | } |