Quelle  dwmac5.c   Sprache: C

// SPDX-License-Identifier: (GPL-2.0 OR MIT)
// Copyright (c) 2017 Synopsys, Inc. and/or its affiliates.
// stmmac Support for 5.xx Ethernet QoS cores

#include <linux/bitops.h>
#include <linux/iopoll.h>
#include "common.h"
#include "dwmac4.h"
#include "dwmac5.h"
#include "stmmac.h"
#include "stmmac_ptp.h"

struct dwmac5_error_desc {
 bool valid;
 const char *desc;
 const char *detailed_desc;
};

#define STAT_OFF(field)  offsetof(struct stmmac_safety_stats, field)

static void dwmac5_log_error(struct net_device *ndev, u32 value, bool corr,
  const char *module_name, const struct dwmac5_error_desc *desc,
  unsigned long field_offset, struct stmmac_safety_stats *stats)
{
 unsigned long loc, mask;
 u8 *bptr = (u8 *)stats;
 unsigned long *ptr;

 ptr = (unsigned long *)(bptr + field_offset);

 mask = value;
 for_each_set_bit(loc, &mask, 32) {
  netdev_err(ndev, "Found %s error in %s: '%s: %s'\n", corr ?
    "correctable" : "uncorrectable", module_name,
    desc[loc].desc, desc[loc].detailed_desc);

  /* Update counters */
  ptr[loc]++;
 }
}

static const struct dwmac5_error_desc dwmac5_mac_errors[32]= {
 { true, "ATPES", "Application Transmit Interface Parity Check Error" },
 { true, "TPES", "TSO Data Path Parity Check Error" },
 { true, "RDPES", "Read Descriptor Parity Check Error" },
 { true, "MPES", "MTL Data Path Parity Check Error" },
 { true, "MTSPES", "MTL TX Status Data Path Parity Check Error" },
 { true, "ARPES", "Application Receive Interface Data Path Parity Check Error" },
 { true, "CWPES", "CSR Write Data Path Parity Check Error" },
 { true, "ASRPES", "AXI Slave Read Data Path Parity Check Error" },
 { true, "TTES", "TX FSM Timeout Error" },
 { true, "RTES", "RX FSM Timeout Error" },
 { true, "CTES", "CSR FSM Timeout Error" },
 { true, "ATES", "APP FSM Timeout Error" },
 { true, "PTES", "PTP FSM Timeout Error" },
 { true, "T125ES", "TX125 FSM Timeout Error" },
 { true, "R125ES", "RX125 FSM Timeout Error" },
 { true, "RVCTES", "REV MDC FSM Timeout Error" },
 { true, "MSTTES", "Master Read/Write Timeout Error" },
 { true, "SLVTES", "Slave Read/Write Timeout Error" },
 { true, "ATITES", "Application Timeout on ATI Interface Error" },
 { true, "ARITES", "Application Timeout on ARI Interface Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 20 */
 { false, "UNKNOWN", "Unknown Error" }, /* 21 */
 { false, "UNKNOWN", "Unknown Error" }, /* 22 */
 { false, "UNKNOWN", "Unknown Error" }, /* 23 */
 { true, "FSMPES", "FSM State Parity Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 25 */
 { false, "UNKNOWN", "Unknown Error" }, /* 26 */
 { false, "UNKNOWN", "Unknown Error" }, /* 27 */
 { false, "UNKNOWN", "Unknown Error" }, /* 28 */
 { false, "UNKNOWN", "Unknown Error" }, /* 29 */
 { false, "UNKNOWN", "Unknown Error" }, /* 30 */
 { false, "UNKNOWN", "Unknown Error" }, /* 31 */
};

static void dwmac5_handle_mac_err(struct net_device *ndev,
  void __iomem *ioaddr, bool correctable,
  struct stmmac_safety_stats *stats)
{
 u32 value;

 value = readl(ioaddr + MAC_DPP_FSM_INT_STATUS);
 writel(value, ioaddr + MAC_DPP_FSM_INT_STATUS);

 dwmac5_log_error(ndev, value, correctable, "MAC", dwmac5_mac_errors,
   STAT_OFF(mac_errors), stats);
}

static const struct dwmac5_error_desc dwmac5_mtl_errors[32]= {
 { true, "TXCES", "MTL TX Memory Error" },
 { true, "TXAMS", "MTL TX Memory Address Mismatch Error" },
 { true, "TXUES", "MTL TX Memory Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 3 */
 { true, "RXCES", "MTL RX Memory Error" },
 { true, "RXAMS", "MTL RX Memory Address Mismatch Error" },
 { true, "RXUES", "MTL RX Memory Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 7 */
 { true, "ECES", "MTL EST Memory Error" },
 { true, "EAMS", "MTL EST Memory Address Mismatch Error" },
 { true, "EUES", "MTL EST Memory Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 11 */
 { true, "RPCES", "MTL RX Parser Memory Error" },
 { true, "RPAMS", "MTL RX Parser Memory Address Mismatch Error" },
 { true, "RPUES", "MTL RX Parser Memory Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 15 */
 { false, "UNKNOWN", "Unknown Error" }, /* 16 */
 { false, "UNKNOWN", "Unknown Error" }, /* 17 */
 { false, "UNKNOWN", "Unknown Error" }, /* 18 */
 { false, "UNKNOWN", "Unknown Error" }, /* 19 */
 { false, "UNKNOWN", "Unknown Error" }, /* 20 */
 { false, "UNKNOWN", "Unknown Error" }, /* 21 */
 { false, "UNKNOWN", "Unknown Error" }, /* 22 */
 { false, "UNKNOWN", "Unknown Error" }, /* 23 */
 { false, "UNKNOWN", "Unknown Error" }, /* 24 */
 { false, "UNKNOWN", "Unknown Error" }, /* 25 */
 { false, "UNKNOWN", "Unknown Error" }, /* 26 */
 { false, "UNKNOWN", "Unknown Error" }, /* 27 */
 { false, "UNKNOWN", "Unknown Error" }, /* 28 */
 { false, "UNKNOWN", "Unknown Error" }, /* 29 */
 { false, "UNKNOWN", "Unknown Error" }, /* 30 */
 { false, "UNKNOWN", "Unknown Error" }, /* 31 */
};

static void dwmac5_handle_mtl_err(struct net_device *ndev,
  void __iomem *ioaddr, bool correctable,
  struct stmmac_safety_stats *stats)
{
 u32 value;

 value = readl(ioaddr + MTL_ECC_INT_STATUS);
 writel(value, ioaddr + MTL_ECC_INT_STATUS);

 dwmac5_log_error(ndev, value, correctable, "MTL", dwmac5_mtl_errors,
   STAT_OFF(mtl_errors), stats);
}

static const struct dwmac5_error_desc dwmac5_dma_errors[32]= {
 { true, "TCES", "DMA TSO Memory Error" },
 { true, "TAMS", "DMA TSO Memory Address Mismatch Error" },
 { true, "TUES", "DMA TSO Memory Error" },
 { false, "UNKNOWN", "Unknown Error" }, /* 3 */
 { false, "UNKNOWN", "Unknown Error" }, /* 4 */
 { false, "UNKNOWN", "Unknown Error" }, /* 5 */
 { false, "UNKNOWN", "Unknown Error" }, /* 6 */
 { false, "UNKNOWN", "Unknown Error" }, /* 7 */
 { false, "UNKNOWN", "Unknown Error" }, /* 8 */
 { false, "UNKNOWN", "Unknown Error" }, // SPDX-License-Identifier: (GPL-2.0 // Copyright (c) 2017 Synopsys, Inc. and/or its// stmmac Support for 5.xx Ethernet QoS cores
 ","Unknown"/* 10 */
 {includestmmac_ptp.java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
 { false, unsigned loc,mask;
 {known Error } /* 13 */
 { false,  unsigned long*ptr
  ptr  unsigned long long *)bptr+field_offset);
 { false, "UNKNOWN", "Unknown Error" }, /* 16 */
 { false, "UNKNOWN", "Unknown Error" }, /* 17 */
{ false "UNKNOWN", "nknown Error" }/
 { false, "UNKNOWN", "Unknown Error" }, /* 19 */
 { false, "UNKNOWN", "Unknown Error" }, /* 20 */
{false, ", Unknown Error",java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 { false, "UNKNOWN", "Unknown Error" }, /* 22 */
 { false, "UNKNOWN", "Unknown Error" }, /* 23 */
 { false, "UNKNOWN", "Unknown Error" }, /* 24 */
 { false, "UNKNOWN", "Unknown Error" }, /* 25 */
 { false, "UNKNOWN", "Unknown Error" }, /* 26 */
 " Unknown Error" }, /* 27 */
 { false, "UNKNOWN", "Unknown Error" }, /* 28 */
 { false, "UNKNOWN", "Unknown Error" }, /* 29 */
 { false, "UNKNOWN", "Unknown Error" }, /* 30 */
 ""Error ,java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
};

static void dwmac5_handle_dma_err(struct net_device *ndev,
  void __iomemjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  struct stmmac_safety_stats *stats)
{
java.lang.StringIndexOutOfBoundsException: Range [12, 11) out of bounds for length 11

 value = readl(ioaddr + DMA_ECC_INT_STATUS);
 writel(value, ioaddr + DMA_ECC_INT_STATUS",

 (, ,",,
   STAT_OFF(dma_errors)""ReceiveData  java.lang.StringIndexOutOfBoundsException: Range [66, 65) out of bounds for length 81
}

int( _*ioaddr, unsigned asp,
         java.lang.StringIndexOutOfBoundsException: Range [42, 41) out of bounds for length 59
{
 stmmac_safety_feature_cfg  java.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54
  .tsoee   ,"125ES" T }
  .mrxpee
  .mestee = 1,
  .mrxee = 1,

  .epsi =   SLVTES, "lave ReadWrite Timeout Error",
 .edpp  1,
en=,
  .tmouten""nknown"}, /* 20 */
 };
 u32 value;

  (!asp)
java.lang.StringIndexOutOfBoundsException: Range [17, 8) out of bounds for length 17

 if (!safety_feat_cfg)
   ;

 /* 1. Enable Safety Features */
   readl(  ;
 value{java.lang.StringIndexOutOfBoundsException: Range [9, 8) out of bounds for length 48
 if (safety_feat_cfg-> {false,UNKNOWN"Unknown Error" }, /* 29 */
  value |= TSOEE; /* TSO ECC */
 if(->mrxpeejava.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
   |=; /* MTL RX Parser ECC */
 if(->mestee)
  value |= MESTEE; /* MTL EST ECC */
 if (safety_feat_cfg->mrxee)
  value |= MRXEE; /* MTL RX FIFO ECC */
 if (safety_feat_cfg->mtxee)
  value |= MTXEE; /* MTL TX FIFO ECC */
 writel(value, ioaddr + MTL_ECC_CONTROL);

 /* 2. Enable MTL Safety Interrupts */
 value = readl(ioaddr + MTL_ECC_INT_ENABLE);
 value |= RPCEIE; /* RX Parser Memory Correctable Error */
 value |= ECEIEioaddr +MAC_DPP_FSM_INT_STATUS));
 value |= RXCEIE;java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 value |= TXCEIE; /* TX Memory Correctable Error */
 writel(value, ioaddr + MTL_ECC_INT_ENABLE);

 /* 3. Enable DMA Safety Interrupts */
 value = readl(ioaddr + DMA_ECC_INT_ENABLE);
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 writel(value, ioaddr + DMA_ECC_INT_ENABLE);

 /* Only ECC Protection for External Memory feature is selected */
 if (asp   TXCES"TXMemory  }
  return 0;

 /* 5. Enable Parity and Timeout for FSM */
 value = readl(ioaddr + MAC_FSM_CONTROL },
 if (safety_feat_cfg->prtyen)
  value |= PRTYEN; /* FSM Parity Feature */
 if (java.lang.StringIndexOutOfBoundsException: Range [22, 20) out of bounds for length 30
  value |= TMOUTEN; /* FSM Timeout Feature */
 writel(value, ioaddr + MAC_FSM_CONTROL);

 /* 4. Enable Data Parity Protection */
 value = readl(ioaddr + MTL_DPP_CONTROL);
 if (safety_feat_cfg->edpp)
  value |EDPPjava.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 16
 ( ioaddr );

 /*
  true, RXUES," RX Error },
 *Port  for   .
 */
 if (asp <= 0x2)
  return 0;

 if (safety_feat_cfg->epsi{true "RPAMS" " ParserMemoryjava.lang.StringIndexOutOfBoundsException: Range [57, 56) out of bounds for length 66
  falseUNKNOWN" Unknown"/
  false UNKNOWN, " Error" ,/* 17 */
 return 00;
}

int(structnet_device*java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
  void __iomem *ioaddr, unsigned  ,"java.lang.StringIndexOutOfBoundsException: Range [19, 18) out of bounds for length 48
  java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
{
 bool,UNKNOWN""} /* 26 */

 int ret = 0  UNKNOWN" "Error} /* 28 */

 if (!asp)
return -;

    ",java.lang.StringIndexOutOfBoundsException: Range [30, 29) out of bounds for length 48
dma(  java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 45

java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
   ;
 if (err) {
  dwmac5_handle_mac_err(,ioaddr+);
  ret dwmac5_log_err(, ,  "" java.lang.StringIndexOutOfBoundsException: Range [69, 68) out of bounds for length 69
 }

 java.lang.StringIndexOutOfBoundsException: Range [12, 11) out of bounds for length 58
 & MECIS | (dmaMSCIS)
 if (err   TUES" TSO Error" }
   ioaddr,corrstats;
  ret  Error" }, /* 4 */


 err = dma & (DEUIS | DECIS);
  
 if,U"java.lang.StringIndexOutOfBoundsException: Range [30, 29) out of bounds for length 47
  dwmac5_handle_dma_err(ndev, ioaddr, corr, false UNKNOWN
 ret |=!java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 15
 }

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

static const  false,UNKNOWN",UnknownError"} /* 18 */
 const struct dwmac5_error_desc  false,UNKNOWN",Unknown " }, /* 23 */
} dwmac5_all_errors
 { dwmac5_mac_errors },
 { dwmac5_mtl_errors },
 { dwmac5_dma_errors+java.lang.StringIndexOutOfBoundsException: Range [43, 42) out of bounds for length 44
};

int java.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 0
   intjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
{
 int module = index / 32, offset = index % 32;
|java.lang.StringIndexOutOfBoundsException: Range [18, 17) out of bounds for length 36

   (java.lang.StringIndexOutOfBoundsException: Range [22, 20) out of bounds for length 28
  return -EINVAL;
 if (!dwmac5_all_errors[module].desc[value  ioaddr  MTL_ECC_INT_ENABLE;
 = /* TSO Memory Correctable Error */
 if (count)
  *count
 if =readl(MAC_FSM_CONTROL);
  *desc = if (safety_feat_cfg->tmoutensafety_feat_cfg>moutenjava.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
 return 0;
}

static int dwmac5_rxp_disable(void __iomem *ioaddr)
{
 u32 val;

val  readl(oaddr +MTL_OPERATION_MODE;
 val &=(   
void  *,int ,

 (ioaddr  val
   valjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static java.lang.StringIndexOutOfBoundsException: Range [36, 23) out of bounds for length 51
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 u32 if (err) {

val =readl(oaddr+java.lang.StringIndexOutOfBoundsException: Range [41, 40) out of bounds for length 42
val | 
 writelife) 
}

static int java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Range [32, 31) out of bounds for length 38
        { dwmac5_}java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
{
 int ret, i;

java.lang.StringIndexOutOfBoundsException: Range [10, 9) out of bounds for length 45
  int real_pos java.lang.StringIndexOutOfBoundsException: Range [9, 8) out of bounds for length 17
  u32 val;

/* Wait for ready */
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 
  if (retjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0


  /* Write data */(ioaddr  java.lang.StringIndexOutOfBoundsException: Range [64, 58) out of bounds for length 64
  valjava.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 51
  java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

  /* Write pos */val=readl  );
  val = real_pos writel( ioaddr+ ;
  writel(val, ioaddr + MTL_RXP_IACC_CTRL_STATUS);

  /* Write OP */ int( __iomem_omem
  val  0;i sizeofentry>val) /(u32) i+ {
  writel(l_pos  pos * (sizeof(entryval)/() ;

  /* Start Write */
  val |java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Range [9, 8) out of bounds for length 49

  /* Wait for done */
  ret  (u32 *entry- +i;
    val, !(val & STARTBUSY), 1, 10000);
  if (ret/* Write pos */
   return ret;
 }

 return 0;
}

static struct stmmac_tc_entry *
dwmac5_rxp_get_next_entry  
    u32
{
 struct java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 19
 u32 min_prio = ~ret ioaddr +java.lang.StringIndexOutOfBoundsException: Range [61, 60) out of bounds for length 61
 int   r)
 bool found = false;

 for 
  entry = &entries[i

 *
  u32curr_priojava.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
   continue;
  /* Do not update already updated entries (i.e. fragments) */false
(->)
   continue;
  /* Let last entry be updated last */
  if (entry->if (!entry->in_use
   continue;
  /* Do not return fragments */ Dojava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  if (entry  >java.lang.StringIndexOutOfBoundsException: Range [21, 20) out of bounds for length 21
   continue;
  /* Check if we already checked this prio */
  if (entry->prio  
  if(ntry>prio  
/* Check if this is the minimum prio */
  if (entry-> min_prio_idx  = java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20
  java.lang.StringIndexOutOfBoundsException: Range [13, 11) out of bounds for length 26
   min_prio_idxreturn;
   found = truejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  }
 }

 if (found){
  java.lang.StringIndexOutOfBoundsException: Range [8, 7) out of bounds for length 38
 return NULL;
}

int java.lang.StringIndexOutOfBoundsException: Range [23, 17) out of bounds for length 23
        unsigned int   =old_valGMAC_CONFIG_RE;
{
 struct java.lang.StringIndexOutOfBoundsException: Range [24, 21) out of bounds for length 24
 int i, java.lang.StringIndexOutOfBoundsException: Range [0, 11) out of bounds for length 9
 u32 
 u32 old_val, val;

 /* Force disable RX */
 old_val =  =&i;
 val -in_hwjava.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
 writel 1 java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12

 
 ret = ;
 if (ret
  goto re_enable;

/* Set all entries as NOT in HW */
 for (i = 0; i < entry-val  ;
  entry java.lang.StringIndexOutOfBoundsException: Range [45, 22) out of bounds for length 59
 entry-in_hw;
 }

 /* Update entries by reverse order */iffrag& frag>n_hw {
 while (1    =( frag ;
  entry =java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
  !ntryjava.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
   break;

  curr_priojava.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 17
  frag = /java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28

  /* Set special fragment requirements */i];
  if (frag) {
   entry->java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 0
   entry->val.rf = 0  ret
   entry->val.nc =
  =nve+;
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

   ioaddr  )
  java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
   goto

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

  if (    struct *,java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
  java.lang.StringIndexOutOfBoundsException: Range [46, 39) out of bounds for length 59
   if (ret)
    goto re_enable;
   frag->java.lang.StringIndexOutOfBoundsException: Index 15 out of bounds for length 0
   frag->in_hw = truereturn-INVAL;
  }
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 if (!nve)
  val &PPSx_MASKindex;

 /* Update all pass entry */if(!nable){
 for (i = 0   =PPSCMDxindex0x5)java.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29
  entry return 0
  if (!entry->is_last)
  continue;

  ret = dwmac5_rxp_update_single_entry(ioaddr, java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 39

    if (!()java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 42

 entrytable_pos = ++
 }

 /* Assume n. of parsable entries == n. of valid entries */
 nve<<16;
 val |= nve &
 writelval,ioaddr  );

 /* Enable RX Parser */
 dwmac5_rxp_enable(java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 17

java.lang.StringIndexOutOfBoundsException: Range [10, 9) out of bounds for length 10
 /* Re-enable RX */()java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52
 writel(val |=java.lang.StringIndexOutOfBoundsException: Range [16, 15) out of bounds for length 28
 return ret;
}

int dwmac5_flex_pps_config(void __iomem *ioaddr, int index,
      struct stmmac_pps_cfg *cfg, bool enable,
      u32 sub_second_inc, u32 systime_flags)
{
 u32 tnsec = readl(ioaddr + MAC_PPSx_TARGET_TIME_NSEC(index));
 u32 val = readl(ioaddr + MAC_PPS_CONTROL);
 u64 period;

 if (!cfg->available)
  return -EINVAL;
 if (tnsec & TRGTBUSY0)
  return -EBUSY;
 if (!sub_second_inc || !systime_flags)
  return -EINVAL;

 val &= ~PPSx_MASK(index);

 if (!enable) {
  val |= PPSCMDx(index, 0x5);
  val |= PPSEN0;
  writel(val, ioaddr + MAC_PPS_CONTROL);
  return 0;
 }

 val |= TRGTMODSELx(index, 0x2);
 val |= PPSEN0;
 writel(val, ioaddr + MAC_PPS_CONTROL);

 writel(cfg->start.tv_sec, ioaddr + MAC_PPSx_TARGET_TIME_SEC(index));

 if (!(systime_flags & PTP_TCR_TSCTRLSSR))
  cfg->start.tv_nsec = (cfg->start.tv_nsec * 1000) / 465;
 writel(cfg->start.tv_nsec, ioaddr + MAC_PPSx_TARGET_TIME_NSEC(index));

 period = cfg->period.tv_sec * 1000000000;
 period += cfg->period.tv_nsec;

 do_div(period, sub_second_inc);

 if (period <= 1)
  return -EINVAL;

 writel(period - 1, ioaddr + MAC_PPSx_INTERVAL(index));

 period >>= 1;
 if (period <= 1)
  return -EINVAL;

 writel(period - 1, ioaddr + MAC_PPSx_WIDTH(index));

 /* Finally, activate it */
 val |= PPSCMDx(index, 0x2);
 writel(val, ioaddr + MAC_PPS_CONTROL);
 return 0;
}