]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * SNTP support driver | |
3 | * | |
4 | * Masami Komiya <mkomiya@sonare.it> 2005 | |
5 | * | |
6 | */ | |
7 | ||
8 | #include <common.h> | |
9 | #include <command.h> | |
10 | #include <dm.h> | |
11 | #include <net.h> | |
12 | #include <rtc.h> | |
13 | ||
14 | #include "sntp.h" | |
15 | ||
16 | #define SNTP_TIMEOUT 10000UL | |
17 | ||
18 | static int sntp_our_port; | |
19 | ||
20 | static void sntp_send(void) | |
21 | { | |
22 | struct sntp_pkt_t pkt; | |
23 | int pktlen = SNTP_PACKET_LEN; | |
24 | int sport; | |
25 | ||
26 | debug("%s\n", __func__); | |
27 | ||
28 | memset(&pkt, 0, sizeof(pkt)); | |
29 | ||
30 | pkt.li = NTP_LI_NOLEAP; | |
31 | pkt.vn = NTP_VERSION; | |
32 | pkt.mode = NTP_MODE_CLIENT; | |
33 | ||
34 | memcpy((char *)net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE, | |
35 | (char *)&pkt, pktlen); | |
36 | ||
37 | sntp_our_port = 10000 + (get_timer(0) % 4096); | |
38 | sport = NTP_SERVICE_PORT; | |
39 | ||
40 | net_send_udp_packet(net_server_ethaddr, net_ntp_server, sport, | |
41 | sntp_our_port, pktlen); | |
42 | } | |
43 | ||
44 | static void sntp_timeout_handler(void) | |
45 | { | |
46 | puts("Timeout\n"); | |
47 | net_set_state(NETLOOP_FAIL); | |
48 | return; | |
49 | } | |
50 | ||
51 | static void sntp_handler(uchar *pkt, unsigned dest, struct in_addr sip, | |
52 | unsigned src, unsigned len) | |
53 | { | |
54 | #ifdef CONFIG_TIMESTAMP | |
55 | struct sntp_pkt_t *rpktp = (struct sntp_pkt_t *)pkt; | |
56 | struct rtc_time tm; | |
57 | ulong seconds; | |
58 | #endif | |
59 | ||
60 | debug("%s\n", __func__); | |
61 | ||
62 | if (dest != sntp_our_port) | |
63 | return; | |
64 | ||
65 | #ifdef CONFIG_TIMESTAMP | |
66 | /* | |
67 | * As the RTC's used in U-Boot support second resolution only | |
68 | * we simply ignore the sub-second field. | |
69 | */ | |
70 | memcpy(&seconds, &rpktp->transmit_timestamp, sizeof(ulong)); | |
71 | ||
72 | rtc_to_tm(ntohl(seconds) - 2208988800UL + net_ntp_time_offset, &tm); | |
73 | #if defined(CONFIG_CMD_DATE) | |
74 | # ifdef CONFIG_DM_RTC | |
75 | struct udevice *dev; | |
76 | int ret; | |
77 | ||
78 | ret = uclass_get_device(UCLASS_RTC, 0, &dev); | |
79 | if (ret) | |
80 | printf("SNTP: cannot find RTC: err=%d\n", ret); | |
81 | else | |
82 | dm_rtc_set(dev, &tm); | |
83 | # else | |
84 | rtc_set(&tm); | |
85 | # endif | |
86 | #endif | |
87 | printf("Date: %4d-%02d-%02d Time: %2d:%02d:%02d\n", | |
88 | tm.tm_year, tm.tm_mon, tm.tm_mday, | |
89 | tm.tm_hour, tm.tm_min, tm.tm_sec); | |
90 | #endif | |
91 | ||
92 | net_set_state(NETLOOP_SUCCESS); | |
93 | } | |
94 | ||
95 | void sntp_start(void) | |
96 | { | |
97 | debug("%s\n", __func__); | |
98 | ||
99 | net_set_timeout_handler(SNTP_TIMEOUT, sntp_timeout_handler); | |
100 | net_set_udp_handler(sntp_handler); | |
101 | memset(net_server_ethaddr, 0, sizeof(net_server_ethaddr)); | |
102 | ||
103 | sntp_send(); | |
104 | } |