libpthread/linuxthreads/ptclock_gettime.c

   1 /* Copyright (C) 2001, 2004 Free Software Foundation, Inc.
   2    This file is part of the GNU C Library.
   3
   4    The GNU C Library is free software; you can redistribute it and/or
   5    modify it under the terms of the GNU Lesser General Public License as
   6    published by the Free Software Foundation; either version 2.1 of the
   7    License, or (at your option) any later version.
   8
   9    The GNU C Library is distributed in the hope that it will be useful,
  10    but WITHOUT ANY WARRANTY; without even the implied warranty of
  11    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12    Lesser General Public License for more details.
  13
  14    You should have received a copy of the GNU Lesser General Public
  15    License along with the GNU C Library; see the file COPYING.LIB.  If not,
  16    write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  17    Boston, MA 02111-1307, USA.  */
  18
  19 #include <errno.h>
  20 #include <time.h>
  21 #include "internals.h"
  22 #include "spinlock.h"
  23
  24
  25 #if HP_TIMING_AVAIL
  26 int
  27 __pthread_clock_gettime (clockid_t clock_id, hp_timing_t freq,
  28                          struct timespec *tp)
  29 {
  30   hp_timing_t tsc, cpuclock_offset;
  31   pthread_descr self = thread_self ();
  32   pthread_t thread = ((unsigned int) clock_id) >> CLOCK_IDFIELD_SIZE;
  33   const unsigned int mask = ~0U >> CLOCK_IDFIELD_SIZE;
  34
  35   if (thread == 0 || (THREAD_GETMEM (self, p_tid) & mask) == thread)
  36     cpuclock_offset = THREAD_GETMEM (self, p_cpuclock_offset);
  37   else
  38     {
  39       pthread_descr th;
  40       pthread_handle handle = thread_handle (thread);
  41       __pthread_lock (&handle->h_lock, NULL);
  42       th = handle->h_descr;
  43       if (th == NULL || (th->p_tid & mask) != thread || th->p_terminated)
  44         {
  45           __pthread_unlock (&handle->h_lock);
  46           __set_errno (EINVAL);
  47           return -1;
  48         }
  49       cpuclock_offset = th->p_cpuclock_offset;
  50       __pthread_unlock (&handle->h_lock);
  51    }
  52
  53   /* Get the current counter.  */
  54   HP_TIMING_NOW (tsc);
  55
  56   /* Compute the offset since the start time of the process.  */
  57   tsc -= cpuclock_offset;
  58
  59   /* Compute the seconds.  */
  60   tp->tv_sec = tsc / freq;
  61
  62   /* And the nanoseconds.  This computation should be stable until
  63      we get machines with about 16GHz frequency.  */
  64   tp->tv_nsec = ((tsc % freq) * 1000000000ull) / freq;
  65
  66   return 0;
  67 }
  68 #endif