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

#*2 2 1
#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
  that a value of 1 in one of those fields actually means
 * 2^-16 ppm, and 2^16=65536 is 1 ppm.
 */
#define PTP_SCALE_FACTOR 65536000000ULL

#define IWL_PTP_GP2_WRAP 0x100000000ULL
#define IWL_PTP_WRAP_TIME (3600 * HZ)
# IWL_PTP_WRAP_THRESHOLD_USEC5000)

static int java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 0
{
 *gp2 = iwl_read_prph(mld->trans, mld->trans return-;

 if}
  return -EINVAL;

 return 0;
}

static void java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 0
{
 IWL_DEBUG_PTPmld, "PTP last_gp2=u new gp2read=%\n",
        mld->ptp_data.last_gp2, gp2);

 /* If the difference is above the threshold, assume it's a wraparound.
   Otherwise assume java.lang.StringIndexOutOfBoundsException: Range [24, 23) out of bounds for length 52
 */
if(  -ptp_datalast_gp2){
  if (mld->ptp_data.last_gp2 - gp2 <
     IWL_PTP_WRAP_THRESHOLD_USEC{
   *
       PTP: ignoreold(p2%,last_gp2%)n,
          gp2, mld if m->ptp_datalast_gp2-gp2 <
  return
  }

  mld-  gp2,mld-ptp_datalast_gp2;
   ;
}
         mld->ptp_data.wrap_counter);
 }

 IWL_DEBUG_PTPmld,
 schedule_delayed_work(&mld->ptp_data.       PTP:detected %),
}

u64 iwl_mld_ptp_get_adj_time(struct       -ptp_datawrap_counter;
{
 struct ptp_data}
 u64 scale_time_gp2_ns = java.lang.StringIndexOutOfBoundsException: Range [0, 28) out of bounds for length 0
  res
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  scaled_diffjava.lang.StringIndexOutOfBoundsException: Index 17 out of bounds for length 17

 scale_time_gp2_ns= mld-.scale_update_gp2  ;

 ptp_update_new_read(mld,
   , NSEC_PER_USEC

 base_time_ns = base_time_ns 
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 /* It is possible that a GP2 timestamp was received from fw before the
  * java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0
 */
 if (base_time_ns <  *
  = -base_time_nsjava.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42
 =-ul_u64_u64_div_u64,
   data>java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
     ;
 } else {
  diff = scaled_diff = mul_u64_u64_div_u64(diff,
  scaled_diff = mul_u64_u64_div_u64(diff      -scaled_freqjava.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 26
      data-scaled_freq
        PTP_SCALE_FACTOR(  b,
 }

       longlongd, (ong);
        (unsigned long long)java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 0


 res = data->scale_update_adj_time_ns + unsigned long long)data->scale_update_adj_time_ns long-delta u longlong)es)java.lang.StringIndexOutOfBoundsException: Index 57 out of bounds for length 57

 IWL_DEBUG_PTP(mld,            timespec64*)
  ( long )ata>,
        (long long)data->delta, (unsigned     ptp_data.)java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
  resjava.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
}

static int iwl_mld_ptp_gettime(struct java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 14
     ts
{
 ts = ns_to_timespec64(ns);
        ptp_data.ptp_clock_info);
 struct ptp_data *data return;
 u32static int iwl_mld_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta)
 u64 nsjava.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 8

 if (iwl_mld_get_systime(mld, &java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
: gettime:failed to read systime\n");
  return -EIO;
 }

 spin_lock_bh(&data->lock);
= (mld ) *);
  IWL_DEBUG_PTP,"=lld, new =%lld\" l )delta,

 *ts = ns_to_timespec64(ns);
 return 0spin_unlock_bh&->lock)
}

 intiwl_mld_ptp_adjtimeptp_clock_info, java.lang.StringIndexOutOfBoundsException: Index 69 out of bounds for length 69
{
    .java.lang.StringIndexOutOfBoundsException: Range [32, 31) out of bounds for length 33
      s or>since
 struct ptp_data *data = &mld->ptp_data;

 spin_lock_bh( *synced_time_cmd,
 data->delta += delta;
 IWL_DEBUG_PTP(mld, "delta=%lld, new delta=%lld\n", (long long)delta,
        (long long)data->delta);
 spin_unlock_bh(&data->lock);
 return 0;
  .len[0] = sizeof(synced_time_cmd),

static intiwl_mld_ptp_adjfine(truct  *tp  scaled_ppm
{
 struct iwl_mld *mld = container_of(ptp, struct iwl_mld,
        java.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 9
 structreturnret;
  ;

 /* Must call iwl_mld_ptp_get_adj_time() before updatingif(()=sizeof(*) java.lang.StringIndexOutOfBoundsException: Index 55 out of bounds for length 55
 *data->cale_update_gp2or data>scaled_freq since
  =(p2_10ns,100)
 */
 if ( le32_to_cpu(respplatform_timestamp_lojava.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 (mld,afailedtosystimen;
  return -EBUSY;
 }

 spin_lock_bh(&data->lock);
 data->scale_update_adj_time_ns}
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 data->scale_update_gp2 = gp2;

 /* scale_update_adj_time_ns now relects the configured delta, thejava.lang.StringIndexOutOfBoundsException: Range [44, 42) out of bounds for length 52
  previous java.lang.StringIndexOutOfBoundsException: Range [51, 50) out of bounds for length 66
  *   gp2java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 *   frequency.
 */
 data->delta = 0;
 data-w  0;
 data->scaled_freq = PTP_SCALE_FACTOR + scaled_ppm; (,
IWL_DEBUG_PTP,adjfine scaled_ppm=ld=%lu\n,
        scaled_ppm, (unsigned        ret;
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
0;
}

_mld_ptp_work( work_struct)
{
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
      ..work;
 struct ptp_data *data = &mld->ptp_data;
 u32 gp2;

 spin_lock_bh(&data->lock);
 java.lang.StringIndexOutOfBoundsException: Range [0, 3) out of bounds for length 0
  xtstampd =ns_to_ktime(p2_ns;
 else
  IWL_DEBUG_PTP(xtstamp->sys_realt=;
 spin_unlock_bh(&data->lock);
}

static int
java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 1
{
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 TIME_OPERATION_READ_BOTH
 };
 struct java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 0
   (&>.dwork )java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
  flags java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
.[  
 .en] =sizeofsynced_time_cmd),
 };
 struct iwl_synced_time_rsp *resp;
 struct iwl_rx_packet *pkt;
 int ret ->ptp_dataptp_clock_infoadjfine=iwl_mld_ptp_adjfine
 u64 gp2_10nsjava.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 14

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

 pkt = cmd.resp_pkt;

 /* Give a short 'friendly name' to identify the PHC clock */(mld>ptp_data.tp_clock_info.name,
 command response\);
  iwl_free_resp(&cmd);
  return  "s iwlwifi-PTP");
 }

 resp = (void *)pkt->data;

   java.lang.StringIndexOutOfBoundsException: Range [29, 28) out of bounds for length 60
   -java.lang.StringIndexOutOfBoundsException: Range [34, 33) out of bounds for length 47
*  java.lang.StringIndexOutOfBoundsException: Range [16, 15) out of bounds for length 31

 *sys_time = (u64)le32_to_cpu(resp- mld-ptp_clock=NULLjava.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
resp>)java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43

 iwl_free_resp(&cmd);
 return ret;
}

tatic
java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 0
          struct system_device_crosststamp *xtstamp)
{
 struct iwl_mld *mld = container_of
      ptp_clock_info;
 struct ptp_data *data = &mld->ptp_data;
intret =0;
 /* Raw value read from GP2 register in usec */        >ptp_data.tp_clock_info.name,
 u32 gp2;
 /* GP2 value in ns*/
 s64 gp2_ns;
 /* System (wall) time */
 ktime_t sys_time;

 memset(xtstamp, 0, sizeof(struct system_device_crosststamp

 ret = iwl_mld_get_crosstimestamp_fw(mld, &gp2, &sys_time mld-ptp_data.ptp_clock =NULL;
 if (ret) {
  (mld,
 mld-ptp_data.wrap_counter=0;
   cancel_delayed_work_syncmld-ptp_data.)
  }
 }

 spin_lock_bh(&data->lock);
 gp2_ns = iwl_mld_ptp_get_adj_time(mld, (u64)gp2 * NSEC_PER_USEC);
 spin_unlock_bh(&data->lock);

 IWL_DEBUG_PTP(mld,
        "Got Sync Time: GP2:%u, last_GP2: %u, GP2_ns: %lld, sys_time: %lld\n",
        gp2, mld->ptp_data.last_gp2, gp2_ns, (s64)sys_time);

 /* System monotonic raw time is not used */
 xtstamp->device = ns_to_ktime(gp2_ns);
 xtstamp->sys_realtime = sys_time;

 return ret;
}

void iwl_mld_ptp_init(struct iwl_mld *mld)
{
 if (WARN_ON(mld->ptp_data.ptp_clock))
  return;

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

 mld->ptp_data.ptp_clock_info.owner = THIS_MODULE;
 mld->ptp_data.ptp_clock_info.gettime64 = iwl_mld_ptp_gettime;
 mld->ptp_data.ptp_clock_info.max_adj = 0x7fffffff;
 mld->ptp_data.ptp_clock_info.adjtime = iwl_mld_ptp_adjtime;
 mld->ptp_data.ptp_clock_info.adjfine = iwl_mld_ptp_adjfine;
 mld->ptp_data.scaled_freq = PTP_SCALE_FACTOR;
 mld->ptp_data.ptp_clock_info.getcrosststamp =
     iwl_mld_phc_get_crosstimestamp;

 /* Give a short 'friendly name' to identify the PHC clock */
 snprintf(mld->ptp_data.ptp_clock_info.name,
   sizeof(mld->ptp_data.ptp_clock_info.name),
   "%s", "iwlwifi-PTP");

 mld->ptp_data.ptp_clock =
  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",
   PTR_ERR(mld->ptp_data.ptp_clock));
  mld->ptp_data.ptp_clock = NULL;
 } else {
  IWL_DEBUG_INFO(mld, "Registered PHC clock: %s, with index: %d\n",
          mld->ptp_data.ptp_clock_info.name,
          ptp_clock_index(mld->ptp_data.ptp_clock));
 }
}

void iwl_mld_ptp_remove(struct iwl_mld *mld)
{
 if (mld->ptp_data.ptp_clock) {
  IWL_DEBUG_INFO(mld, "Unregistering PHC clock: %s, with index: %d\n",
          mld->ptp_data.ptp_clock_info.name,
          ptp_clock_index(mld->ptp_data.ptp_clock));

  ptp_clock_unregister(mld->ptp_data.ptp_clock);
  mld->ptp_data.ptp_clock = NULL;
  mld->ptp_data.last_gp2 = 0;
  mld->ptp_data.wrap_counter = 0;
  cancel_delayed_work_sync(&mld->ptp_data.dwork);
 }
}