1 /*- 2 * Copyright (c) 2009 Adrian Chadd 3 * Copyright (c) 2012 Spectra Logic Corporation 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 */ 28 29 /** 30 * \file dev/xen/timer/timer.c 31 * \brief A timer driver for the Xen hypervisor's PV clock. 32 */ 33 34 #include <sys/cdefs.h> 35 __FBSDID("$FreeBSD$"); 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/bus.h> 40 #include <sys/kernel.h> 41 #include <sys/module.h> 42 #include <sys/time.h> 43 #include <sys/timetc.h> 44 #include <sys/timeet.h> 45 #include <sys/smp.h> 46 #include <sys/limits.h> 47 #include <sys/clock.h> 48 #include <sys/proc.h> 49 50 #include <xen/xen-os.h> 51 #include <xen/features.h> 52 #include <xen/xen_intr.h> 53 #include <xen/hypervisor.h> 54 #include <xen/interface/io/xenbus.h> 55 #include <xen/interface/vcpu.h> 56 #include <xen/error.h> 57 58 #include <machine/cpu.h> 59 #include <machine/cpufunc.h> 60 #include <machine/clock.h> 61 #include <machine/_inttypes.h> 62 #include <machine/smp.h> 63 #include <machine/pvclock.h> 64 65 #include <dev/xen/timer/timer.h> 66 67 #include <isa/rtc.h> 68 69 #include "clock_if.h" 70 71 static devclass_t xentimer_devclass; 72 73 #define NSEC_IN_SEC 1000000000ULL 74 #define NSEC_IN_USEC 1000ULL 75 /* 18446744073 = int(2^64 / NSEC_IN_SC) = 1 ns in 64-bit fractions */ 76 #define FRAC_IN_NSEC 18446744073LL 77 78 /* Xen timers may fire up to 100us off */ 79 #define XENTIMER_MIN_PERIOD_IN_NSEC 100*NSEC_IN_USEC 80 #define XENCLOCK_RESOLUTION 1000001 /* ATRTC resolution + 1 */ 81 82 #define XENTIMER_QUALITY 950 83 84 struct xentimer_pcpu_data { 85 uint64_t timer; 86 uint64_t last_processed; 87 void *irq_handle; 88 }; 89 90 DPCPU_DEFINE(struct xentimer_pcpu_data, xentimer_pcpu); 91 92 DPCPU_DECLARE(struct vcpu_info *, vcpu_info); 93 94 struct xentimer_softc { 95 device_t dev; 96 struct timecounter tc; 97 struct eventtimer et; 98 }; 99 100 static void 101 xentimer_identify(driver_t *driver, device_t parent) 102 { 103 if (!xen_domain()) 104 return; 105 106 /* Handle all Xen PV timers in one device instance. */ 107 if (devclass_get_device(xentimer_devclass, 0)) 108 return; 109 110 BUS_ADD_CHILD(parent, 0, "xen_et", 0); 111 } 112 113 static int 114 xentimer_probe(device_t dev) 115 { 116 KASSERT((xen_domain()), ("Trying to use Xen timer on bare metal")); 117 /* 118 * In order to attach, this driver requires the following: 119 * - Vector callback support by the hypervisor, in order to deliver 120 * timer interrupts to the correct CPU for CPUs other than 0. 121 * - Access to the hypervisor shared info page, in order to look up 122 * each VCPU's timer information and the Xen wallclock time. 123 * - The hypervisor must say its PV clock is "safe" to use. 124 * - The hypervisor must support VCPUOP hypercalls. 125 * - The maximum number of CPUs supported by FreeBSD must not exceed 126 * the number of VCPUs supported by the hypervisor. 127 */ 128 #define XTREQUIRES(condition, reason...) \ 129 if (!(condition)) { \ 130 device_printf(dev, ## reason); \ 131 device_detach(dev); \ 132 return (ENXIO); \ 133 } 134 135 if (xen_hvm_domain()) { 136 XTREQUIRES(xen_vector_callback_enabled, 137 "vector callbacks unavailable\n"); 138 XTREQUIRES(xen_feature(XENFEAT_hvm_safe_pvclock), 139 "HVM safe pvclock unavailable\n"); 140 } 141 XTREQUIRES(HYPERVISOR_shared_info != NULL, 142 "shared info page unavailable\n"); 143 XTREQUIRES(HYPERVISOR_vcpu_op(VCPUOP_stop_periodic_timer, 0, NULL) == 0, 144 "VCPUOPs interface unavailable\n"); 145 #undef XTREQUIRES 146 device_set_desc(dev, "Xen PV Clock"); 147 return (BUS_PROBE_NOWILDCARD); 148 } 149 150 /** 151 * \brief Get the current time, in nanoseconds, since the hypervisor booted. 152 * 153 * \param vcpu vcpu_info structure to fetch the time from. 154 * 155 */ 156 static uint64_t 157 xen_fetch_vcpu_time(struct vcpu_info *vcpu) 158 { 159 struct pvclock_vcpu_time_info *time; 160 161 time = (struct pvclock_vcpu_time_info *) &vcpu->time; 162 163 return (pvclock_get_timecount(time)); 164 } 165 166 static uint32_t 167 xentimer_get_timecount(struct timecounter *tc) 168 { 169 uint64_t vcpu_time; 170 171 /* 172 * We don't disable preemption here because the worst that can 173 * happen is reading the vcpu_info area of a different CPU than 174 * the one we are currently running on, but that would also 175 * return a valid tc (and we avoid the overhead of 176 * critical_{enter/exit} calls). 177 */ 178 vcpu_time = xen_fetch_vcpu_time(DPCPU_GET(vcpu_info)); 179 180 return (vcpu_time & UINT32_MAX); 181 } 182 183 /** 184 * \brief Fetch the hypervisor boot time, known as the "Xen wallclock". 185 * 186 * \param ts Timespec to store the current stable value. 187 * \param version Pointer to store the corresponding wallclock version. 188 * 189 * \note This value is updated when Domain-0 shifts its clock to follow 190 * clock drift, e.g. as detected by NTP. 191 */ 192 static void 193 xen_fetch_wallclock(struct timespec *ts) 194 { 195 shared_info_t *src = HYPERVISOR_shared_info; 196 struct pvclock_wall_clock *wc; 197 198 wc = (struct pvclock_wall_clock *) &src->wc_version; 199 200 pvclock_get_wallclock(wc, ts); 201 } 202 203 static void 204 xen_fetch_uptime(struct timespec *ts) 205 { 206 uint64_t uptime; 207 208 uptime = xen_fetch_vcpu_time(DPCPU_GET(vcpu_info)); 209 210 ts->tv_sec = uptime / NSEC_IN_SEC; 211 ts->tv_nsec = uptime % NSEC_IN_SEC; 212 } 213 214 static int 215 xentimer_settime(device_t dev __unused, struct timespec *ts) 216 { 217 struct xen_platform_op settime; 218 int ret; 219 220 /* 221 * Don't return EINVAL here; just silently fail if the domain isn't 222 * privileged enough to set the TOD. 223 */ 224 if (!xen_initial_domain()) 225 return (0); 226 227 /* Set the native RTC. */ 228 atrtc_set(ts); 229 230 settime.cmd = XENPF_settime64; 231 settime.u.settime64.mbz = 0; 232 settime.u.settime64.secs = ts->tv_sec; 233 settime.u.settime64.nsecs = ts->tv_nsec; 234 settime.u.settime64.system_time = 235 xen_fetch_vcpu_time(DPCPU_GET(vcpu_info)); 236 237 ret = HYPERVISOR_platform_op(&settime); 238 ret = ret != 0 ? xen_translate_error(ret) : 0; 239 if (ret != 0 && bootverbose) 240 device_printf(dev, "failed to set Xen PV clock: %d\n", ret); 241 242 return (ret); 243 } 244 245 /** 246 * \brief Return current time according to the Xen Hypervisor wallclock. 247 * 248 * \param dev Xentimer device. 249 * \param ts Pointer to store the wallclock time. 250 * 251 * \note The Xen time structures document the hypervisor start time and the 252 * uptime-since-hypervisor-start (in nsec.) They need to be combined 253 * in order to calculate a TOD clock. 254 */ 255 static int 256 xentimer_gettime(device_t dev, struct timespec *ts) 257 { 258 struct timespec u_ts; 259 260 timespecclear(ts); 261 xen_fetch_wallclock(ts); 262 xen_fetch_uptime(&u_ts); 263 timespecadd(ts, &u_ts); 264 265 return (0); 266 } 267 268 /** 269 * \brief Handle a timer interrupt for the Xen PV timer driver. 270 * 271 * \param arg Xen timer driver softc that is expecting the interrupt. 272 */ 273 static int 274 xentimer_intr(void *arg) 275 { 276 struct xentimer_softc *sc = (struct xentimer_softc *)arg; 277 struct xentimer_pcpu_data *pcpu = DPCPU_PTR(xentimer_pcpu); 278 279 pcpu->last_processed = xen_fetch_vcpu_time(DPCPU_GET(vcpu_info)); 280 if (pcpu->timer != 0 && sc->et.et_active) 281 sc->et.et_event_cb(&sc->et, sc->et.et_arg); 282 283 return (FILTER_HANDLED); 284 } 285 286 static int 287 xentimer_vcpu_start_timer(int vcpu, uint64_t next_time) 288 { 289 struct vcpu_set_singleshot_timer single; 290 291 single.timeout_abs_ns = next_time; 292 /* Get an event anyway, even if the timeout is already expired */ 293 single.flags = 0; 294 return (HYPERVISOR_vcpu_op(VCPUOP_set_singleshot_timer, vcpu, &single)); 295 } 296 297 static int 298 xentimer_vcpu_stop_timer(int vcpu) 299 { 300 301 return (HYPERVISOR_vcpu_op(VCPUOP_stop_singleshot_timer, vcpu, NULL)); 302 } 303 304 /** 305 * \brief Set the next oneshot time for the current CPU. 306 * 307 * \param et Xen timer driver event timer to schedule on. 308 * \param first Delta to the next time to schedule the interrupt for. 309 * \param period Not used. 310 * 311 * \note See eventtimers(9) for more information. 312 * \note 313 * 314 * \returns 0 315 */ 316 static int 317 xentimer_et_start(struct eventtimer *et, 318 sbintime_t first, sbintime_t period) 319 { 320 int error; 321 struct xentimer_softc *sc = et->et_priv; 322 int cpu = PCPU_GET(vcpu_id); 323 struct xentimer_pcpu_data *pcpu = DPCPU_PTR(xentimer_pcpu); 324 struct vcpu_info *vcpu = DPCPU_GET(vcpu_info); 325 uint64_t first_in_ns, next_time; 326 #ifdef INVARIANTS 327 struct thread *td = curthread; 328 #endif 329 330 KASSERT(td->td_critnest != 0, 331 ("xentimer_et_start called without preemption disabled")); 332 333 /* See sbttots() for this formula. */ 334 first_in_ns = (((first >> 32) * NSEC_IN_SEC) + 335 (((uint64_t)NSEC_IN_SEC * (uint32_t)first) >> 32)); 336 337 next_time = xen_fetch_vcpu_time(vcpu) + first_in_ns; 338 error = xentimer_vcpu_start_timer(cpu, next_time); 339 if (error) 340 panic("%s: Error %d setting singleshot timer to %"PRIu64"\n", 341 device_get_nameunit(sc->dev), error, next_time); 342 343 pcpu->timer = next_time; 344 return (error); 345 } 346 347 /** 348 * \brief Cancel the event timer's currently running timer, if any. 349 */ 350 static int 351 xentimer_et_stop(struct eventtimer *et) 352 { 353 int cpu = PCPU_GET(vcpu_id); 354 struct xentimer_pcpu_data *pcpu = DPCPU_PTR(xentimer_pcpu); 355 356 pcpu->timer = 0; 357 return (xentimer_vcpu_stop_timer(cpu)); 358 } 359 360 /** 361 * \brief Attach a Xen PV timer driver instance. 362 * 363 * \param dev Bus device object to attach. 364 * 365 * \note 366 * \returns EINVAL 367 */ 368 static int 369 xentimer_attach(device_t dev) 370 { 371 struct xentimer_softc *sc = device_get_softc(dev); 372 int error, i; 373 374 sc->dev = dev; 375 376 /* Bind an event channel to a VIRQ on each VCPU. */ 377 CPU_FOREACH(i) { 378 struct xentimer_pcpu_data *pcpu; 379 380 pcpu = DPCPU_ID_PTR(i, xentimer_pcpu); 381 error = HYPERVISOR_vcpu_op(VCPUOP_stop_periodic_timer, i, NULL); 382 if (error) { 383 device_printf(dev, "Error disabling Xen periodic timer " 384 "on CPU %d\n", i); 385 return (error); 386 } 387 388 error = xen_intr_bind_virq(dev, VIRQ_TIMER, i, xentimer_intr, 389 NULL, sc, INTR_TYPE_CLK, &pcpu->irq_handle); 390 if (error) { 391 device_printf(dev, "Error %d binding VIRQ_TIMER " 392 "to VCPU %d\n", error, i); 393 return (error); 394 } 395 xen_intr_describe(pcpu->irq_handle, "c%d", i); 396 } 397 398 /* Register the event timer. */ 399 sc->et.et_name = "XENTIMER"; 400 sc->et.et_quality = XENTIMER_QUALITY; 401 sc->et.et_flags = ET_FLAGS_ONESHOT | ET_FLAGS_PERCPU; 402 sc->et.et_frequency = NSEC_IN_SEC; 403 /* See tstosbt() for this formula */ 404 sc->et.et_min_period = (XENTIMER_MIN_PERIOD_IN_NSEC * 405 (((uint64_t)1 << 63) / 500000000) >> 32); 406 sc->et.et_max_period = ((sbintime_t)4 << 32); 407 sc->et.et_start = xentimer_et_start; 408 sc->et.et_stop = xentimer_et_stop; 409 sc->et.et_priv = sc; 410 et_register(&sc->et); 411 412 /* Register the timecounter. */ 413 sc->tc.tc_name = "XENTIMER"; 414 sc->tc.tc_quality = XENTIMER_QUALITY; 415 sc->tc.tc_flags = TC_FLAGS_SUSPEND_SAFE; 416 /* 417 * The underlying resolution is in nanoseconds, since the timer info 418 * scales TSC frequencies using a fraction that represents time in 419 * terms of nanoseconds. 420 */ 421 sc->tc.tc_frequency = NSEC_IN_SEC; 422 sc->tc.tc_counter_mask = ~0u; 423 sc->tc.tc_get_timecount = xentimer_get_timecount; 424 sc->tc.tc_priv = sc; 425 tc_init(&sc->tc); 426 427 /* Register the Hypervisor wall clock */ 428 clock_register(dev, XENCLOCK_RESOLUTION); 429 430 return (0); 431 } 432 433 static int 434 xentimer_detach(device_t dev) 435 { 436 437 /* Implement Xen PV clock teardown - XXX see hpet_detach ? */ 438 /* If possible: 439 * 1. need to deregister timecounter 440 * 2. need to deregister event timer 441 * 3. need to deregister virtual IRQ event channels 442 */ 443 return (EBUSY); 444 } 445 446 static void 447 xentimer_percpu_resume(void *arg) 448 { 449 device_t dev = (device_t) arg; 450 struct xentimer_softc *sc = device_get_softc(dev); 451 452 xentimer_et_start(&sc->et, sc->et.et_min_period, 0); 453 } 454 455 static int 456 xentimer_resume(device_t dev) 457 { 458 int error; 459 int i; 460 461 /* Disable the periodic timer */ 462 CPU_FOREACH(i) { 463 error = HYPERVISOR_vcpu_op(VCPUOP_stop_periodic_timer, i, NULL); 464 if (error != 0) { 465 device_printf(dev, 466 "Error disabling Xen periodic timer on CPU %d\n", 467 i); 468 return (error); 469 } 470 } 471 472 /* Reset the last uptime value */ 473 pvclock_resume(); 474 475 /* Kick the timers on all CPUs */ 476 smp_rendezvous(NULL, xentimer_percpu_resume, NULL, dev); 477 478 if (bootverbose) 479 device_printf(dev, "resumed operation after suspension\n"); 480 481 return (0); 482 } 483 484 static int 485 xentimer_suspend(device_t dev) 486 { 487 return (0); 488 } 489 490 /* 491 * Xen early clock init 492 */ 493 void 494 xen_clock_init(void) 495 { 496 } 497 498 /* 499 * Xen PV DELAY function 500 * 501 * When running on PVH mode we don't have an emulated i8524, so 502 * make use of the Xen time info in order to code a simple DELAY 503 * function that can be used during early boot. 504 */ 505 void 506 xen_delay(int n) 507 { 508 struct vcpu_info *vcpu = &HYPERVISOR_shared_info->vcpu_info[0]; 509 uint64_t end_ns; 510 uint64_t current; 511 512 end_ns = xen_fetch_vcpu_time(vcpu); 513 end_ns += n * NSEC_IN_USEC; 514 515 for (;;) { 516 current = xen_fetch_vcpu_time(vcpu); 517 if (current >= end_ns) 518 break; 519 } 520 } 521 522 static device_method_t xentimer_methods[] = { 523 DEVMETHOD(device_identify, xentimer_identify), 524 DEVMETHOD(device_probe, xentimer_probe), 525 DEVMETHOD(device_attach, xentimer_attach), 526 DEVMETHOD(device_detach, xentimer_detach), 527 DEVMETHOD(device_suspend, xentimer_suspend), 528 DEVMETHOD(device_resume, xentimer_resume), 529 /* clock interface */ 530 DEVMETHOD(clock_gettime, xentimer_gettime), 531 DEVMETHOD(clock_settime, xentimer_settime), 532 DEVMETHOD_END 533 }; 534 535 static driver_t xentimer_driver = { 536 "xen_et", 537 xentimer_methods, 538 sizeof(struct xentimer_softc), 539 }; 540 541 DRIVER_MODULE(xentimer, xenpv, xentimer_driver, xentimer_devclass, 0, 0); 542 MODULE_DEPEND(xentimer, xenpv, 1, 1, 1); 543