+220 -8

Cargo.lock

··· 49 49 checksum = "9330f8b2ff13f34540b44e946ef35111825727b38d33286ef986142615121801" 50 50 51 51 [[package]] 52 52 + name = "chrono" 53 53 + version = "0.4.42" 54 54 + source = "registry+https://github.com/rust-lang/crates.io-index" 55 55 + checksum = "145052bdd345b87320e369255277e3fb5152762ad123a901ef5c262dd38fe8d2" 56 56 + dependencies = [ 57 57 + "num-traits", 58 58 + ] 59 59 + 60 60 + [[package]] 52 61 name = "core-foundation" 53 62 version = "0.10.0" 54 63 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 63 72 version = "0.8.7" 64 73 source = "registry+https://github.com/rust-lang/crates.io-index" 65 74 checksum = "773648b94d0e5d620f64f280777445740e61fe701025087ec8b57f45c791888b" 75 75 + 76 76 + [[package]] 77 77 + name = "critical-section" 78 78 + version = "1.2.0" 79 79 + source = "registry+https://github.com/rust-lang/crates.io-index" 80 80 + checksum = "790eea4361631c5e7d22598ecd5723ff611904e3344ce8720784c93e3d83d40b" 66 81 67 82 [[package]] 68 83 name = "defmt" ··· 106 121 ] 107 122 108 123 [[package]] 124 124 + name = "document-features" 125 125 + version = "0.2.12" 126 126 + source = "registry+https://github.com/rust-lang/crates.io-index" 127 127 + checksum = "d4b8a88685455ed29a21542a33abd9cb6510b6b129abadabdcef0f4c55bc8f61" 128 128 + dependencies = [ 129 129 + "litrs", 130 130 + ] 131 131 + 132 132 + [[package]] 133 133 + name = "embassy-net" 134 134 + version = "0.7.1" 135 135 + source = "registry+https://github.com/rust-lang/crates.io-index" 136 136 + checksum = "0558a231a47e7d4a06a28b5278c92e860f1200f24821d2f365a2f40fe3f3c7b2" 137 137 + dependencies = [ 138 138 + "document-features", 139 139 + "embassy-net-driver", 140 140 + "embassy-sync", 141 141 + "embassy-time", 142 142 + "embedded-io-async", 143 143 + "embedded-nal-async", 144 144 + "heapless 0.8.0", 145 145 + "managed", 146 146 + "smoltcp", 147 147 + ] 148 148 + 149 149 + [[package]] 150 150 + name = "embassy-net-driver" 151 151 + version = "0.2.0" 152 152 + source = "registry+https://github.com/rust-lang/crates.io-index" 153 153 + checksum = "524eb3c489760508f71360112bca70f6e53173e6fe48fc5f0efd0f5ab217751d" 154 154 + 155 155 + [[package]] 156 156 + name = "embassy-sync" 157 157 + version = "0.7.2" 158 158 + source = "registry+https://github.com/rust-lang/crates.io-index" 159 159 + checksum = "73974a3edbd0bd286759b3d483540f0ebef705919a5f56f4fc7709066f71689b" 160 160 + dependencies = [ 161 161 + "cfg-if", 162 162 + "critical-section", 163 163 + "embedded-io-async", 164 164 + "futures-core", 165 165 + "futures-sink", 166 166 + "heapless 0.8.0", 167 167 + ] 168 168 + 169 169 + [[package]] 170 170 + name = "embassy-time" 171 171 + version = "0.5.0" 172 172 + source = "registry+https://github.com/rust-lang/crates.io-index" 173 173 + checksum = "f4fa65b9284d974dad7a23bb72835c4ec85c0b540d86af7fc4098c88cff51d65" 174 174 + dependencies = [ 175 175 + "cfg-if", 176 176 + "critical-section", 177 177 + "document-features", 178 178 + "embassy-time-driver", 179 179 + "embedded-hal 0.2.7", 180 180 + "embedded-hal 1.0.0", 181 181 + "embedded-hal-async", 182 182 + "futures-core", 183 183 + ] 184 184 + 185 185 + [[package]] 186 186 + name = "embassy-time-driver" 187 187 + version = "0.2.1" 188 188 + source = "registry+https://github.com/rust-lang/crates.io-index" 189 189 + checksum = "a0a244c7dc22c8d0289379c8d8830cae06bb93d8f990194d0de5efb3b5ae7ba6" 190 190 + dependencies = [ 191 191 + "document-features", 192 192 + ] 193 193 + 194 194 + [[package]] 195 195 + name = "embedded-hal" 196 196 + version = "0.2.7" 197 197 + source = "registry+https://github.com/rust-lang/crates.io-index" 198 198 + checksum = "35949884794ad573cf46071e41c9b60efb0cb311e3ca01f7af807af1debc66ff" 199 199 + dependencies = [ 200 200 + "nb 0.1.3", 201 201 + "void", 202 202 + ] 203 203 + 204 204 + [[package]] 109 205 name = "embedded-hal" 110 206 version = "1.0.0" 111 207 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 120 216 source = "registry+https://github.com/rust-lang/crates.io-index" 121 217 checksum = "0c4c685bbef7fe13c3c6dd4da26841ed3980ef33e841cddfa15ce8a8fb3f1884" 122 218 dependencies = [ 123 123 - "embedded-hal", 219 219 + "embedded-hal 1.0.0", 124 220 ] 125 221 126 222 [[package]] ··· 129 225 source = "registry+https://github.com/rust-lang/crates.io-index" 130 226 checksum = "f9a0f04f8886106faf281c47b6a0e4054a369baedaf63591fdb8da9761f3f379" 131 227 dependencies = [ 132 132 - "embedded-hal", 228 228 + "embedded-hal 1.0.0", 133 229 "embedded-hal-nb", 134 230 ] 135 231 ··· 139 235 source = "registry+https://github.com/rust-lang/crates.io-index" 140 236 checksum = "fba4268c14288c828995299e59b12babdbe170f6c6d73731af1b4648142e8605" 141 237 dependencies = [ 142 142 - "embedded-hal", 143 143 - "nb", 238 238 + "embedded-hal 1.0.0", 239 239 + "nb 1.1.0", 240 240 + ] 241 241 + 242 242 + [[package]] 243 243 + name = "embedded-io" 244 244 + version = "0.6.1" 245 245 + source = "registry+https://github.com/rust-lang/crates.io-index" 246 246 + checksum = "edd0f118536f44f5ccd48bcb8b111bdc3de888b58c74639dfb034a357d0f206d" 247 247 + 248 248 + [[package]] 249 249 + name = "embedded-io-async" 250 250 + version = "0.6.1" 251 251 + source = "registry+https://github.com/rust-lang/crates.io-index" 252 252 + checksum = "3ff09972d4073aa8c299395be75161d582e7629cd663171d62af73c8d50dba3f" 253 253 + dependencies = [ 254 254 + "embedded-io", 255 255 + ] 256 256 + 257 257 + [[package]] 258 258 + name = "embedded-nal" 259 259 + version = "0.9.0" 260 260 + source = "registry+https://github.com/rust-lang/crates.io-index" 261 261 + checksum = "c56a28be191a992f28f178ec338a0bf02f63d7803244add736d026a471e6ed77" 262 262 + dependencies = [ 263 263 + "nb 1.1.0", 264 264 + ] 265 265 + 266 266 + [[package]] 267 267 + name = "embedded-nal-async" 268 268 + version = "0.8.0" 269 269 + source = "registry+https://github.com/rust-lang/crates.io-index" 270 270 + checksum = "76959917cd2b86f40a98c28dd5624eddd1fa69d746241c8257eac428d83cb211" 271 271 + dependencies = [ 272 272 + "embedded-io-async", 273 273 + "embedded-nal", 144 274 ] 145 275 146 276 [[package]] ··· 150 280 checksum = "3a3076410a55c90011c298b04d0cfa770b00fa04e1e3c97d3f6c9de105a03844" 151 281 152 282 [[package]] 283 283 + name = "futures-core" 284 284 + version = "0.3.31" 285 285 + source = "registry+https://github.com/rust-lang/crates.io-index" 286 286 + checksum = "05f29059c0c2090612e8d742178b0580d2dc940c837851ad723096f87af6663e" 287 287 + 288 288 + [[package]] 289 289 + name = "futures-sink" 290 290 + version = "0.3.31" 291 291 + source = "registry+https://github.com/rust-lang/crates.io-index" 292 292 + checksum = "e575fab7d1e0dcb8d0c7bcf9a63ee213816ab51902e6d244a95819acacf1d4f7" 293 293 + 294 294 + [[package]] 153 295 name = "gpio-cdev" 154 296 version = "0.6.0" 155 297 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 171 313 172 314 [[package]] 173 315 name = "heapless" 316 316 + version = "0.8.0" 317 317 + source = "registry+https://github.com/rust-lang/crates.io-index" 318 318 + checksum = "0bfb9eb618601c89945a70e254898da93b13be0388091d42117462b265bb3fad" 319 319 + dependencies = [ 320 320 + "hash32", 321 321 + "stable_deref_trait", 322 322 + ] 323 323 + 324 324 + [[package]] 325 325 + name = "heapless" 174 326 version = "0.9.2" 175 327 source = "registry+https://github.com/rust-lang/crates.io-index" 176 328 checksum = "2af2455f757db2b292a9b1768c4b70186d443bcb3b316252d6b540aec1cd89ed" ··· 215 367 checksum = "2a8a605c95f708c78554738a12153b213f107d3bd5323f7ce32d6deb3faafb40" 216 368 dependencies = [ 217 369 "cast", 218 218 - "embedded-hal", 370 370 + "embedded-hal 1.0.0", 219 371 "embedded-hal-nb", 220 372 "gpio-cdev", 221 373 "i2cdev", 222 222 - "nb", 374 374 + "nb 1.1.0", 223 375 "nix 0.27.1", 224 376 "serialport", 225 377 "spidev", ··· 227 379 ] 228 380 229 381 [[package]] 382 382 + name = "litrs" 383 383 + version = "1.0.0" 384 384 + source = "registry+https://github.com/rust-lang/crates.io-index" 385 385 + checksum = "11d3d7f243d5c5a8b9bb5d6dd2b1602c0cb0b9db1621bafc7ed66e35ff9fe092" 386 386 + 387 387 + [[package]] 230 388 name = "mach2" 231 389 version = "0.4.3" 232 390 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 236 394 ] 237 395 238 396 [[package]] 397 397 + name = "managed" 398 398 + version = "0.8.0" 399 399 + source = "registry+https://github.com/rust-lang/crates.io-index" 400 400 + checksum = "0ca88d725a0a943b096803bd34e73a4437208b6077654cc4ecb2947a5f91618d" 401 401 + 402 402 + [[package]] 239 403 name = "memoffset" 240 404 version = "0.6.5" 241 405 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 251 415 checksum = "5de893c32cde5f383baa4c04c5d6dbdd735cfd4a794b0debdb2bb1b421da5ff4" 252 416 dependencies = [ 253 417 "autocfg", 418 418 + ] 419 419 + 420 420 + [[package]] 421 421 + name = "nb" 422 422 + version = "0.1.3" 423 423 + source = "registry+https://github.com/rust-lang/crates.io-index" 424 424 + checksum = "801d31da0513b6ec5214e9bf433a77966320625a37860f910be265be6e18d06f" 425 425 + dependencies = [ 426 426 + "nb 1.1.0", 254 427 ] 255 428 256 429 [[package]] ··· 297 470 ] 298 471 299 472 [[package]] 473 473 + name = "num-traits" 474 474 + version = "0.2.19" 475 475 + source = "registry+https://github.com/rust-lang/crates.io-index" 476 476 + checksum = "071dfc062690e90b734c0b2273ce72ad0ffa95f0c74596bc250dcfd960262841" 477 477 + dependencies = [ 478 478 + "autocfg", 479 479 + ] 480 480 + 481 481 + [[package]] 300 482 name = "pin-utils" 301 483 version = "0.1.0" 302 484 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 351 533 version = "0.1.0" 352 534 dependencies = [ 353 535 "defmt 1.0.1", 354 354 - "heapless", 536 536 + "heapless 0.9.2", 355 537 "sachy-fmt", 356 538 ] 357 539 ··· 371 553 version = "0.1.0" 372 554 dependencies = [ 373 555 "defmt 1.0.1", 374 374 - "embedded-hal", 556 556 + "embedded-hal 1.0.0", 375 557 "embedded-hal-async", 376 558 "embedded-hal-mock", 377 559 "linux-embedded-hal", 378 560 ] 379 561 380 562 [[package]] 563 563 + name = "sachy-sntp" 564 564 + version = "0.1.0" 565 565 + dependencies = [ 566 566 + "chrono", 567 567 + "defmt 1.0.1", 568 568 + "embassy-net", 569 569 + "embassy-time", 570 570 + "sachy-fmt", 571 571 + ] 572 572 + 573 573 + [[package]] 381 574 name = "scopeguard" 382 575 version = "1.2.0" 383 576 source = "registry+https://github.com/rust-lang/crates.io-index" ··· 407 600 version = "1.3.0" 408 601 source = "registry+https://github.com/rust-lang/crates.io-index" 409 602 checksum = "0fda2ff0d084019ba4d7c6f371c95d8fd75ce3524c3cb8fb653a3023f6323e64" 603 603 + 604 604 + [[package]] 605 605 + name = "smoltcp" 606 606 + version = "0.12.0" 607 607 + source = "registry+https://github.com/rust-lang/crates.io-index" 608 608 + checksum = "dad095989c1533c1c266d9b1e8d70a1329dd3723c3edac6d03bbd67e7bf6f4bb" 609 609 + dependencies = [ 610 610 + "bitflags 1.3.2", 611 611 + "byteorder", 612 612 + "cfg-if", 613 613 + "heapless 0.8.0", 614 614 + "managed", 615 615 + ] 410 616 411 617 [[package]] 412 618 name = "spidev" ··· 479 685 version = "1.0.22" 480 686 source = "registry+https://github.com/rust-lang/crates.io-index" 481 687 checksum = "9312f7c4f6ff9069b165498234ce8be658059c6728633667c526e27dc2cf1df5" 688 688 + 689 689 + [[package]] 690 690 + name = "void" 691 691 + version = "1.0.2" 692 692 + source = "registry+https://github.com/rust-lang/crates.io-index" 693 693 + checksum = "6a02e4885ed3bc0f2de90ea6dd45ebcbb66dacffe03547fadbb0eeae2770887d" 482 694 483 695 [[package]] 484 696 name = "windows-sys"

+9 -2

Cargo.toml

··· 1 1 [workspace] 2 2 resolver = "3" 3 3 - members = ["sachy-battery","sachy-bthome", "sachy-fmt", "sachy-fnv", "sachy-shtc3"] 3 3 + members = ["sachy-battery","sachy-bthome", "sachy-fmt", "sachy-fnv", "sachy-shtc3", "sachy-sntp"] 4 4 5 5 [workspace.package] 6 6 authors = ["Sachymetsu <sachymetsu@tutamail.com>"] ··· 8 8 repository = "https://tangled.org/sachy.dev/sachy-embed-core/" 9 9 license = "MIT OR Apache-2.0" 10 10 version = "0.1.0" 11 11 - rust-version = "1.88.0" 11 11 + rust-version = "1.89.0" 12 12 + 13 13 + [workspace.dependencies] 14 14 + embassy-futures = { version = "0.1" } 15 15 + embassy-time = { version = "0.5" } 16 16 + embassy-sync = { version = "0.7" } 17 17 + embassy-net = { version = "0.7" } 18 18 + defmt = { version = "1" }

+1 -1

sachy-fmt/Cargo.toml

··· 9 9 rust-version = { workspace = true } 10 10 11 11 [dependencies] 12 12 - defmt = { version = "1", optional = true } 12 12 + defmt = { workspace = true, optional = true } 13 13 14 14 [features] 15 15 defmt = ["dep:defmt"]

+26

sachy-sntp/Cargo.toml

··· 1 1 + [package] 2 2 + name = "sachy-sntp" 3 3 + authors.workspace = true 4 4 + edition.workspace = true 5 5 + repository.workspace = true 6 6 + license.workspace = true 7 7 + version.workspace = true 8 8 + rust-version.workspace = true 9 9 + 10 10 + [dependencies] 11 11 + chrono = { version = "0.4.41", default-features = false, optional = true } 12 12 + defmt = { workspace = true, optional = true } 13 13 + embassy-net = { workspace = true, features = [ 14 14 + "udp", 15 15 + "proto-ipv4", 16 16 + "medium-ip", 17 17 + "medium-ethernet", 18 18 + ], optional = true } 19 19 + embassy-time = { workspace = true, optional = true } 20 20 + sachy-fmt = { path = "../sachy-fmt" } 21 21 + 22 22 + [features] 23 23 + default = ["chrono", "embassy-net"] 24 24 + chrono = ["dep:chrono"] 25 25 + embassy-net = ["dep:embassy-net", "dep:embassy-time"] 26 26 + defmt = ["dep:defmt"]

+209

sachy-sntp/src/lib.rs

··· 1 1 + #![no_std] 2 2 + 3 3 + #[derive(Debug, PartialEq, Eq)] 4 4 + #[cfg_attr(feature = "defmt", derive(defmt::Format))] 5 5 + pub enum SntpError { 6 6 + InvalidPacket, 7 7 + InvalidVersion, 8 8 + InvalidMode, 9 9 + KissOfDeath, 10 10 + InvalidTime, 11 11 + NetFailure, 12 12 + NetTimeout, 13 13 + } 14 14 + 15 15 + pub struct SntpRequest; 16 16 + 17 17 + #[derive(Debug, PartialEq, Eq, Clone, Copy)] 18 18 + #[cfg_attr(feature = "defmt", derive(defmt::Format))] 19 19 + /// SNTP timestamp. 20 20 + pub struct SntpTimestamp(u64); 21 21 + 22 22 + impl SntpTimestamp { 23 23 + pub fn microseconds(&self) -> u64 { 24 24 + (self.0 >> 32) * 1_000_000 + ((self.0 & 0xFFFFFFFF) * 1_000_000 / 0x100000000) 25 25 + } 26 26 + 27 27 + /// Returns true if the most significant bit is set. 28 28 + /// 29 29 + /// Relevant documentation from RFC 2030: 30 30 + /// 31 31 + /// ```text 32 32 + /// Note that, since some time in 1968 (second 2,147,483,648) the most 33 33 + /// significant bit (bit 0 of the integer part) has been set and that the 34 34 + /// 64-bit field will overflow some time in 2036 (second 4,294,967,296). 35 35 + /// Should NTP or SNTP be in use in 2036, some external means will be 36 36 + /// necessary to qualify time relative to 1900 and time relative to 2036 37 37 + /// (and other multiples of 136 years). There will exist a 200-picosecond 38 38 + /// interval, henceforth ignored, every 136 years when the 64-bit field 39 39 + /// will be 0, which by convention is interpreted as an invalid or 40 40 + /// unavailable timestamp. 41 41 + /// As the NTP timestamp format has been in use for the last 17 years, 42 42 + /// it remains a possibility that it will be in use 40 years from now 43 43 + /// when the seconds field overflows. As it is probably inappropriate 44 44 + /// to archive NTP timestamps before bit 0 was set in 1968, a 45 45 + /// convenient way to extend the useful life of NTP timestamps is the 46 46 + /// following convention: If bit 0 is set, the UTC time is in the 47 47 + /// range 1968-2036 and UTC time is reckoned from 0h 0m 0s UTC on 1 48 48 + /// January 1900. If bit 0 is not set, the time is in the range 2036- 49 49 + /// 2104 and UTC time is reckoned from 6h 28m 16s UTC on 7 February 50 50 + /// 2036. Note that when calculating the correspondence, 2000 is not a 51 51 + /// leap year. Note also that leap seconds are not counted in the 52 52 + /// reckoning. 53 53 + ///``` 54 54 + pub fn msb_set(&self) -> bool { 55 55 + self.0 & (1 << 63) != 0 56 56 + } 57 57 + 58 58 + /// Microseconds since the UNIX epoch. 59 59 + pub fn utc_micros(&self) -> i64 { 60 60 + let ntp_epoch_micros = self.microseconds() as i64; 61 61 + let offset: i64 = if self.msb_set() { 62 62 + -2208988800000000 63 63 + } else { 64 64 + 2085978496000000 65 65 + }; 66 66 + 67 67 + ntp_epoch_micros + offset 68 68 + } 69 69 + 70 70 + #[cfg(feature = "chrono")] 71 71 + pub fn try_to_naive_datetime(self) -> Result<chrono::NaiveDateTime, SntpError> { 72 72 + self.try_into() 73 73 + } 74 74 + } 75 75 + 76 76 + impl SntpRequest { 77 77 + pub const SNTP_PACKET_SIZE: usize = 48; 78 78 + 79 79 + pub const fn create_packet() -> [u8; Self::SNTP_PACKET_SIZE] { 80 80 + let mut packet = [0u8; Self::SNTP_PACKET_SIZE]; 81 81 + packet[0] = (3 << 6) | (4 << 3) | 3; 82 82 + packet 83 83 + } 84 84 + 85 85 + pub fn create_packet_from_buffer(packet: &mut [u8]) -> Result<(), SntpError> { 86 86 + if packet.len() != Self::SNTP_PACKET_SIZE { 87 87 + return Err(SntpError::InvalidPacket); 88 88 + } 89 89 + 90 90 + packet[0] = (3 << 6) | (4 << 3) | 3; 91 91 + 92 92 + Ok(()) 93 93 + } 94 94 + 95 95 + pub fn read_timestamp(packet: &[u8]) -> Result<SntpTimestamp, SntpError> { 96 96 + if packet.len() == Self::SNTP_PACKET_SIZE { 97 97 + let header = packet[0]; 98 98 + let version = (header & 0x38) >> 3; 99 99 + 100 100 + if version != 4 { 101 101 + return Err(SntpError::InvalidVersion); 102 102 + } 103 103 + 104 104 + let mode = header & 0x7; 105 105 + 106 106 + if !(4..=5).contains(&mode) { 107 107 + return Err(SntpError::InvalidMode); 108 108 + } 109 109 + 110 110 + let kiss_of_death = packet[1] == 0; 111 111 + 112 112 + if kiss_of_death { 113 113 + return Err(SntpError::KissOfDeath); 114 114 + } 115 115 + 116 116 + let timestamp = SntpTimestamp(read_be_u64(&packet[40..48])); 117 117 + 118 118 + return Ok(timestamp); 119 119 + } 120 120 + 121 121 + Err(SntpError::InvalidPacket) 122 122 + } 123 123 + 124 124 + #[cfg(feature = "chrono")] 125 125 + pub fn as_naive_datetime(raw_time: SntpTimestamp) -> Result<chrono::NaiveDateTime, SntpError> { 126 126 + raw_time.try_into() 127 127 + } 128 128 + } 129 129 + 130 130 + #[cfg(feature = "chrono")] 131 131 + impl TryFrom<SntpTimestamp> for chrono::NaiveDateTime { 132 132 + type Error = SntpError; 133 133 + 134 134 + fn try_from(timestamp: SntpTimestamp) -> Result<Self, Self::Error> { 135 135 + Ok(chrono::DateTime::<chrono::Utc>::try_from(timestamp)?.naive_utc()) 136 136 + } 137 137 + } 138 138 + 139 139 + #[cfg(feature = "chrono")] 140 140 + impl TryFrom<SntpTimestamp> for chrono::DateTime<chrono::Utc> { 141 141 + type Error = SntpError; 142 142 + 143 143 + fn try_from(timestamp: SntpTimestamp) -> Result<Self, Self::Error> { 144 144 + chrono::DateTime::<chrono::Utc>::from_timestamp_micros(timestamp.utc_micros()) 145 145 + .ok_or(SntpError::InvalidTime) 146 146 + } 147 147 + } 148 148 + 149 149 + #[inline] 150 150 + fn read_be_u64(input: &[u8]) -> u64 { 151 151 + let (int_bytes, _) = input.split_at(core::mem::size_of::<u64>()); 152 152 + u64::from_be_bytes(int_bytes.try_into().unwrap()) 153 153 + } 154 154 + 155 155 + #[cfg(feature = "embassy-net")] 156 156 + pub trait SntpSocket { 157 157 + fn resolve_time( 158 158 + &mut self, 159 159 + addrs: &[embassy_net::IpAddress], 160 160 + ) -> impl Future<Output = Result<SntpTimestamp, SntpError>>; 161 161 + } 162 162 + 163 163 + #[cfg(feature = "embassy-net")] 164 164 + impl SntpSocket for embassy_net::udp::UdpSocket<'_> { 165 165 + async fn resolve_time( 166 166 + &mut self, 167 167 + addrs: &[embassy_net::IpAddress], 168 168 + ) -> Result<SntpTimestamp, SntpError> { 169 169 + use embassy_time::{Duration, WithTimeout}; 170 170 + use sachy_fmt::{debug, error}; 171 171 + 172 172 + if addrs.is_empty() { 173 173 + return Err(SntpError::NetFailure); 174 174 + } 175 175 + 176 176 + debug!("SNTP address list: {}", addrs); 177 177 + 178 178 + let addr = addrs[0]; 179 179 + 180 180 + debug!("Binding to port 123"); 181 181 + self.bind(123).map_err(|_| SntpError::NetFailure)?; 182 182 + 183 183 + debug!("Sending SNTP request"); 184 184 + self.send_to_with( 185 185 + SntpRequest::SNTP_PACKET_SIZE, 186 186 + embassy_net::IpEndpoint::new(addr, 123), 187 187 + SntpRequest::create_packet_from_buffer, 188 188 + ) 189 189 + .await 190 190 + .map_err(|e| { 191 191 + error!("Failed to send: {}", e); 192 192 + SntpError::NetFailure 193 193 + })??; 194 194 + 195 195 + debug!("Waiting for a response..."); 196 196 + let res = self 197 197 + .recv_from_with(|buf, _from| SntpRequest::read_timestamp(buf)) 198 198 + .with_timeout(Duration::from_secs(5)) 199 199 + .await 200 200 + .map_err(|_| SntpError::NetTimeout) 201 201 + .flatten(); 202 202 + 203 203 + debug!("Received: {}", &res); 204 204 + debug!("Closing SNTP port..."); 205 205 + self.close(); 206 206 + 207 207 + res 208 208 + } 209 209 + }