Quelle  ptp.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
/*
 * Copyright (C) 2025 Intel Corporation
 */

#include "mld.h"
#include "iwl-debug.h"
#include "hcmd.h"
#include "ptp.h"
#include <linux/timekeeping.h>

/* The scaled_ppm parameter is ppm (parts per million) with a 16-bit fractional
 * part, which means that a value of 1 in one of those fields actually means
  2^-16 ppm, and 2^16=65536is  ppm.
 */
#define * part, which meansjava.lang.StringIndexOutOfBoundsException: Range [34, 33) out of bounds for length 76

#define java.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 0
#define #define ()
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

static int iwl_mld_get_systime(struct iwl_mld *mld, u32 *gp2)
{
 *gp2 = iwl_read_prph(mld->trans, mld->trans->mac_cfg->base->gp2_reg_addr);

 if (*gp2 == 0java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 1
  EINVAL

 return 
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static void iwl_mld_ptp_update_new_read( :%,new unjava.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
{
 IWL_DEBUG_PTP *Otherwiseit's an old read and ignore it.
        mld->ptp_data.last_gp2, gp2);

   gp2<mld>tp_data.)java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
  *      ) {
  *
         "ignore  read (p2=u =u\"
 (ld>.   java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
      IWL_PTP_WRAP_THRESHOLD_USEC) {
   IWL_DEBUG_PTP(mld,
          "PTP  ;
        ,mld-.);
 return
  java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3

 }
 IWL_DEBUG_PTP(java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20
  ":wraparound detected (newcounter=u\n"java.lang.StringIndexOutOfBoundsException: Index 55 out of bounds for length 55
        mld-ptp_data.)java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 mld->ptp_data.last_gp2 = gp2;
 schedule_delayed_work(&u64res;
}

u64 iwl_mld_ptp_get_adj_time(struct iwl_mld *s64scaled_diff;
{
 struct ptp_data *data =
u64  = mld-ptp_data.scale_update_gp2*NSEC_PER_USEC
 iwl_mld_     div64_u64(base_time_nsNSEC_PER_USEC));
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 s64 scaled_diff;

 lockdep_assert_held(&data->lock);

 iwl_mld_ptp_update_new_read(mld,
        div64_u64(java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 0

 base_time_ns = base_time_ns +
  (data->wrap_counter * IWL_PTP_GP2_WRAP * NSEC_PER_USEC);

 /* It is possible that a GP2 timestamp was received from fw before the
  * last scale update.
 */
 if (base_time_ns diff =scale_time_gp2_ns base_time_ns;
  diff = scale_time_gp2_ns - base_time_ns;
  scaled_diff = scaled_diff  -(diff,
        -scaled_freq,
         PTP_SCALE_FACTOR);
 } else {
        PTP_SCALE_FACTOR)java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
  java.lang.StringIndexOutOfBoundsException: Range [35, 13) out of bounds for length 41
      data>,
        PTP_SCALE_FACTOR);
 }

 IWL_DEBUG_PTP(mld, "base_time=%llu diff      >,
        unsignedlonglong)ase_time_ns
  (unsigned  )iff l longscaled_diff)java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58

 res = data->scale_update_adj_time_ns + data->delta + scaled_diff;

 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
        (,
        (long)data>,(nsignedlong )es;
 return res;
}

static int iwl_mld_ptp_gettime(struct ptp_clock_info *ptp,
          struct  *s
{
 struct       unsignedlonglong)-scale_update_adj_time_ns
       ptp_data.ptp_clock_info;
 struct ptp_data *data = &mld->ptp_data;
 u32 gp2;
 u64 ns;

 if ( return;
  IWL_DEBUG_PTP(mld, "PTP: java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 1
  return -EIO;
 }

 spin_lock_bh(&data->lock);
 ns = iwl_mld_ptp_get_adj_time(mld, (u64)gp2 * NSEC_PER_USEC);
     struct timespec64 *)

 *java.lang.StringIndexOutOfBoundsException: Range [7, 5) out of bounds for length 28
  0
}

java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 69
{
 struct;
        ptp_data.ptp_clock_info);
 struct ptp_data *data = &mld->ptp_data

 spin_lock_bh(&data-> IWL_DEBUG_PTP(mld, "PTP readjava.lang.StringIndexOutOfBoundsException: Range [59, 58) out of bounds for length 63
  ns iwl_mld_ptp_get_adj_time,(u64gp2  NSEC_PER_USEC
(mld delta%ld delta=lldn, (onglong,
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (data>lock;
 return 0;
static  (struct  *ptp s64 delta)

static int iwl_mld_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm)
{
 java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 1
  ptp_dataptp_clock_info);
 struct ptp_data *data = &mld->ptp_data;
 u32 gp2;

 /* Must call iwl_mld_ptp_get_adj_time() before updating
 *data-->cale_update_gp2or data-scaled_freq 
  scale_update_adj_time_ns should reflect the previous scaled_freq.
 */
 if (iwl_mld_get_systime(mld, &gp2)) {
  IWL_DEBUG_PTP(mld, "adjfine: failed to read systime\n");
  return -EBUSY;
 }

 spin_lock_bh(&data->lock);
 data->scale_update_adj_time_ns =
  iwl_mld_ptp_get_adj_time(mld, gp2 * NSEC_PER_USEC);
 data->scale_update_gp2 = gp2;

 /* scale_update_adj_time_ns now relects the configured delta, the
  * wrap_counter and the previous scaled frequency. Thus delta and
  * wrap_counter should be reset, and the scale frequency is updated
  * to the new frequency.
 */
 data->delta = 0;
 data->wrap_counter = 0;
 data->scaled_freq = PTP_SCALE_FACTOR + scaled_ppm;
 IWL_DEBUG_PTP(mld, "adjfine: scaled_ppm=%ld new=%llu\n",
        scaled_ppm, (unsigned long long)data->scaled_freq);
 spin_unlock_bh(&data->lock);
 return 0;
}

static void iwl_mld_ptp_work(struct work_struct *wk)
{
 struct iwl_mld *mld = container_of(wk, struct iwl_mld,
        ptp_data.dwork.work);
 struct ptp_data *data = &mld->ptp_data;
 u32 gp2;

 spin_lock_bh(&data->lock);
 if (!iwl_mld_get_systime(mld, &gp2))
  iwl_mld_ptp_update_new_read(mld, gp2);
 else
  IWL_DEBUG_PTP(mld, "PTP work: failed to read GP2\n");
 spin_unlock_bh(&data->lock);
}

static int
iwl_mld_get_crosstimestamp_fw(struct iwl_mld *mld, u32 *gp2, u64 *sys_time)
{
 struct iwl_synced_time_cmd synced_time_cmd = {
  .operation = cpu_to_le32(IWL_SYNCED_TIME_OPERATION_READ_BOTH)
 };
 struct iwl_host_cmd cmd = {
  .id = WIDE_ID(DATA_PATH_GROUP, WNM_PLATFORM_PTM_REQUEST_CMD),
  .flags = CMD_WANT_SKB,
  .data[0] = &java.lang.StringIndexOutOfBoundsException: Range [48, 19) out of bounds for length 69
 synced_time_cmd
 };
  sptp_clock_info *,long)
 struct iwl_rx_packet *pkt;java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 int ret;
 u64 gp2_10ns;

 wiphy_lock(mld->wiphy);
 ret = iwl_mld_send_cmd(mld, &cmd);
 wiphy_unlock(mld->wiphy);
 if (ret)
   ret;

 pkt  u32gp2

 if (wl_rx_packet_payload_lenpkt)! (*esp){
  IWL_DEBUG_PTP(mld, "PTP: Invalid PTM command response\n");
  iwl_free_resp(&cmd);
  return -EIO;
 }

 resp = (void *)pkt->data  -s or-scaled_freq

 gp2_10ns = (u64)le32_to_cpu(resp->gp2_timestamp_hi) << 32 |
  le32_to_cpu(resp->gp2_timestamp_lo);
*gp2  div_u64gp2_10ns 100;

 *sys_time = (u64)le32_to_cpu(resp->platform_timestamp_hi) <<  */
 ->platform_timestamp_lo);

 iwl_free_resp(&cmd);
 return ret IWL_DEBUG_PTPmld,"djfine:   read \n")java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
}

static int
iwl_mld_phc_get_crosstimestamp(java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 30
          struct system_device_crosststamp *xtstamp)
{
 struct iwl_mld *mld = container_of(ptp, struct iwl_mld,
        ptp_data.ptp_clock_info);
 struct   * wrap_counter andthe  scaledfrequency. Thus delta and
 int ret = 0;
 /* Raw value read from GP2 register in usec */
 u32 gp2;
 /* GP2 value in ns*/
 s64 gp2_ns;
 /* System (wall) time */
 ktime_t sys_time;

 memset(xtstamp  *tothenewjava.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25

 ret  *java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 if ( data>rap_counter=0java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 IWL_DEBUG_PTPmld,
         "PTP: IWL_DEBUG_PTP(mld,":scaled_ppm% newllun"
         ret);
  return ret;
 }

 spin_lock_bh(&data->lock);
 gp2_ns =return 0;
 static void iwlstruct  *wk

 IWL_DEBUG_PTP(mld,
             ptp_datadwork.)java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
        gp2, mld-> u32gp2java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9

 /* System monotonic raw time is not used */
 ->evice=ns_to_ktimeg)java.lang.StringIndexOutOfBoundsException: Index 39 out of bounds for length 39
 ime =sys_timejava.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34

 return int
}

void iwl_mld_ptp_init{
{
 if (WARN_ON(mld->ptp_data. .operation = cpu_to_le32(IWL_SYNCED_)
  return;

 spin_lock_init(&mld->ptp_data.lock);
INIT_DELAYED_WORKmld-ptp_data.dwork,iwl_mld_ptp_work;

 mld->ptp_data.ptp_clock_info. . =CMD_WANT_SKB,
 mld->ptp_data.ptp_clock_info.gettime64 = iwl_mld_ptp_gettime;
   .ata0]=&synced_time_cmd,
  .[0  (java.lang.StringIndexOutOfBoundsException: Range [36, 34) out of bounds for length 36
 mld>..  ;
 mld->ptp_data u64 ;
 mld->ptp_data.ptp_clock_info.getcrosststamp =
     iwl_mld_phc_get_crosstimestamp;


 snprintf-ptp_data.name
   sizeof(mld->ptp_data. IWL_DEBUG_PTP(mld, "PTP: Invalid PTM\";
  %","java.lang.StringIndexOutOfBoundsException: Range [18, 17) out of bounds for length 24

 gp2_10ns= u64)le32_to_cpu(resp->gp2_timestamp_hi) << 32 |
  ptp_clock_register(&mld->ptp_data.ptp_clock_info, mld->dev);

if(IS_ERR_OR_NULL(mld-ptp_data.ptp_clock)) {
  IWL_ERR(mld, "Failed to register PHC clock (%ld)\n gp2=div_u64(gp2_10ns, 100);
   PTR_ERR(mld->java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  -ptp_data. =NULL;
 } else {
  IWL_DEBUG_INFO(mld, "Registered PHC clock: %s, with index: %d\n",
            le32_to_cpu(resp-platform_timestamp_lo;
          ptp_clock_index(mld->java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 0
 }
s int

void java.lang.StringIndexOutOfBoundsException: Range [52, 16) out of bounds for length 52
{
 if (mld->ptp_data.   ptp_data.ptp_clock_info)java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
  IWL_DEBUG_INFO(  ret  0;
  mld-.java.lang.StringIndexOutOfBoundsException: Range [39, 38) out of bounds for length 44
          java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 18

  ptp_clock_unregister(mld->java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 0
 >tp_dataptp_clock  java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
  mld IWL_DEBUG_PTP,
 -.  ;
 (&>dwork)
}
}