Branch data     Line data    Source code

       1                 :            : // SPDX-License-Identifier: GPL-2.0
       2                 :            : /*
       3                 :            :  * Copyright 2019 ARM Ltd.
       4                 :            :  *
       5                 :            :  * Generic implementation of update_vsyscall and update_vsyscall_tz.
       6                 :            :  *
       7                 :            :  * Based on the x86 specific implementation.
       8                 :            :  */
       9                 :            : 
      10                 :            : #include <linux/hrtimer.h>
      11                 :            : #include <linux/timekeeper_internal.h>
      12                 :            : #include <vdso/datapage.h>
      13                 :            : #include <vdso/helpers.h>
      14                 :            : #include <vdso/vsyscall.h>
      15                 :            : 
      16                 :      50512 : static inline void update_vdso_data(struct vdso_data *vdata,
      17                 :            :                                     struct timekeeper *tk)
      18                 :            : {
      19                 :      50512 :         struct vdso_timestamp *vdso_ts;
      20                 :      50512 :         u64 nsec, sec;
      21                 :            : 
      22                 :      50512 :         vdata[CS_HRES_COARSE].cycle_last        = tk->tkr_mono.cycle_last;
      23                 :      50512 :         vdata[CS_HRES_COARSE].mask              = tk->tkr_mono.mask;
      24                 :      50512 :         vdata[CS_HRES_COARSE].mult              = tk->tkr_mono.mult;
      25                 :      50512 :         vdata[CS_HRES_COARSE].shift             = tk->tkr_mono.shift;
      26                 :      50512 :         vdata[CS_RAW].cycle_last                = tk->tkr_raw.cycle_last;
      27                 :      50512 :         vdata[CS_RAW].mask                      = tk->tkr_raw.mask;
      28                 :      50512 :         vdata[CS_RAW].mult                      = tk->tkr_raw.mult;
      29                 :      50512 :         vdata[CS_RAW].shift                     = tk->tkr_raw.shift;
      30                 :            : 
      31                 :            :         /* CLOCK_MONOTONIC */
      32                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_MONOTONIC];
      33                 :      50512 :         vdso_ts->sec = tk->xtime_sec + tk->wall_to_monotonic.tv_sec;
      34                 :            : 
      35                 :      50512 :         nsec = tk->tkr_mono.xtime_nsec;
      36                 :      50512 :         nsec += ((u64)tk->wall_to_monotonic.tv_nsec << tk->tkr_mono.shift);
      37         [ +  + ]:      74309 :         while (nsec >= (((u64)NSEC_PER_SEC) << tk->tkr_mono.shift)) {
      38                 :      23797 :                 nsec -= (((u64)NSEC_PER_SEC) << tk->tkr_mono.shift);
      39                 :      23797 :                 vdso_ts->sec++;
      40                 :            :         }
      41                 :      50512 :         vdso_ts->nsec        = nsec;
      42                 :            : 
      43                 :            :         /* Copy MONOTONIC time for BOOTTIME */
      44                 :      50512 :         sec     = vdso_ts->sec;
      45                 :            :         /* Add the boot offset */
      46                 :      50512 :         sec     += tk->monotonic_to_boot.tv_sec;
      47                 :      50512 :         nsec    += (u64)tk->monotonic_to_boot.tv_nsec << tk->tkr_mono.shift;
      48                 :            : 
      49                 :            :         /* CLOCK_BOOTTIME */
      50                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_BOOTTIME];
      51                 :      50512 :         vdso_ts->sec = sec;
      52                 :            : 
      53         [ -  + ]:      50512 :         while (nsec >= (((u64)NSEC_PER_SEC) << tk->tkr_mono.shift)) {
      54                 :          0 :                 nsec -= (((u64)NSEC_PER_SEC) << tk->tkr_mono.shift);
      55                 :          0 :                 vdso_ts->sec++;
      56                 :            :         }
      57                 :      50512 :         vdso_ts->nsec        = nsec;
      58                 :            : 
      59                 :            :         /* CLOCK_MONOTONIC_RAW */
      60                 :      50512 :         vdso_ts         = &vdata[CS_RAW].basetime[CLOCK_MONOTONIC_RAW];
      61                 :      50512 :         vdso_ts->sec = tk->raw_sec;
      62                 :      50512 :         vdso_ts->nsec        = tk->tkr_raw.xtime_nsec;
      63                 :            : 
      64                 :            :         /* CLOCK_TAI */
      65                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_TAI];
      66                 :      50512 :         vdso_ts->sec = tk->xtime_sec + (s64)tk->tai_offset;
      67                 :      50512 :         vdso_ts->nsec        = tk->tkr_mono.xtime_nsec;
      68                 :      50512 : }
      69                 :            : 
      70                 :      50512 : void update_vsyscall(struct timekeeper *tk)
      71                 :            : {
      72                 :      50512 :         struct vdso_data *vdata = __arch_get_k_vdso_data();
      73                 :      50512 :         struct vdso_timestamp *vdso_ts;
      74                 :      50512 :         u64 nsec;
      75                 :            : 
      76                 :            :         /* copy vsyscall data */
      77                 :      50512 :         vdso_write_begin(vdata);
      78                 :            : 
      79                 :      50512 :         vdata[CS_HRES_COARSE].clock_mode        = __arch_get_clock_mode(tk);
      80                 :      50512 :         vdata[CS_RAW].clock_mode                = __arch_get_clock_mode(tk);
      81                 :            : 
      82                 :            :         /* CLOCK_REALTIME also required for time() */
      83                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_REALTIME];
      84                 :      50512 :         vdso_ts->sec = tk->xtime_sec;
      85                 :      50512 :         vdso_ts->nsec        = tk->tkr_mono.xtime_nsec;
      86                 :            : 
      87                 :            :         /* CLOCK_REALTIME_COARSE */
      88                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_REALTIME_COARSE];
      89                 :      50512 :         vdso_ts->sec = tk->xtime_sec;
      90                 :      50512 :         vdso_ts->nsec        = tk->tkr_mono.xtime_nsec >> tk->tkr_mono.shift;
      91                 :            : 
      92                 :            :         /* CLOCK_MONOTONIC_COARSE */
      93                 :      50512 :         vdso_ts         = &vdata[CS_HRES_COARSE].basetime[CLOCK_MONOTONIC_COARSE];
      94                 :      50512 :         vdso_ts->sec = tk->xtime_sec + tk->wall_to_monotonic.tv_sec;
      95                 :      50512 :         nsec            = tk->tkr_mono.xtime_nsec >> tk->tkr_mono.shift;
      96                 :      50512 :         nsec            = nsec + tk->wall_to_monotonic.tv_nsec;
      97                 :      50512 :         vdso_ts->sec += __iter_div_u64_rem(nsec, NSEC_PER_SEC, &vdso_ts->nsec);
      98                 :            : 
      99                 :            :         /*
     100                 :            :          * Read without the seqlock held by clock_getres().
     101                 :            :          * Note: No need to have a second copy.
     102                 :            :          */
     103                 :      50512 :         WRITE_ONCE(vdata[CS_HRES_COARSE].hrtimer_res, hrtimer_resolution);
     104                 :            : 
     105                 :            :         /*
     106                 :            :          * Architectures can opt out of updating the high resolution part
     107                 :            :          * of the VDSO.
     108                 :            :          */
     109                 :      50512 :         if (__arch_update_vdso_data())
     110                 :      50512 :                 update_vdso_data(vdata, tk);
     111                 :            : 
     112                 :      50512 :         __arch_update_vsyscall(vdata, tk);
     113                 :            : 
     114                 :      50512 :         vdso_write_end(vdata);
     115                 :            : 
     116                 :      50512 :         __arch_sync_vdso_data(vdata);
     117                 :      50512 : }
     118                 :            : 
     119                 :         21 : void update_vsyscall_tz(void)
     120                 :            : {
     121                 :         21 :         struct vdso_data *vdata = __arch_get_k_vdso_data();
     122                 :            : 
     123                 :         21 :         vdata[CS_HRES_COARSE].tz_minuteswest = sys_tz.tz_minuteswest;
     124                 :         21 :         vdata[CS_HRES_COARSE].tz_dsttime = sys_tz.tz_dsttime;
     125                 :            : 
     126                 :         21 :         __arch_sync_vdso_data(vdata);
     127                 :         21 : }