LCOV - code coverage report
Current view: top level - drivers/ssb - driver_chipcommon.c (source / functions) Hit Total Coverage
Test: combined.info Lines: 0 276 0.0 %
Date: 2022-03-28 13:20:08 Functions: 0 24 0.0 %
Branches: 0 131 0.0 %

           Branch data     Line data    Source code
       1                 :            : /*
       2                 :            :  * Sonics Silicon Backplane
       3                 :            :  * Broadcom ChipCommon core driver
       4                 :            :  *
       5                 :            :  * Copyright 2005, Broadcom Corporation
       6                 :            :  * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
       7                 :            :  * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
       8                 :            :  *
       9                 :            :  * Licensed under the GNU/GPL. See COPYING for details.
      10                 :            :  */
      11                 :            : 
      12                 :            : #include "ssb_private.h"
      13                 :            : 
      14                 :            : #include <linux/ssb/ssb.h>
      15                 :            : #include <linux/ssb/ssb_regs.h>
      16                 :            : #include <linux/export.h>
      17                 :            : #include <linux/pci.h>
      18                 :            : #include <linux/bcm47xx_wdt.h>
      19                 :            : 
      20                 :            : 
      21                 :            : /* Clock sources */
      22                 :            : enum ssb_clksrc {
      23                 :            :         /* PCI clock */
      24                 :            :         SSB_CHIPCO_CLKSRC_PCI,
      25                 :            :         /* Crystal slow clock oscillator */
      26                 :            :         SSB_CHIPCO_CLKSRC_XTALOS,
      27                 :            :         /* Low power oscillator */
      28                 :            :         SSB_CHIPCO_CLKSRC_LOPWROS,
      29                 :            : };
      30                 :            : 
      31                 :            : 
      32                 :          0 : static inline u32 chipco_write32_masked(struct ssb_chipcommon *cc, u16 offset,
      33                 :            :                                         u32 mask, u32 value)
      34                 :            : {
      35                 :          0 :         value &= mask;
      36                 :          0 :         value |= chipco_read32(cc, offset) & ~mask;
      37                 :          0 :         chipco_write32(cc, offset, value);
      38                 :            : 
      39                 :          0 :         return value;
      40                 :            : }
      41                 :            : 
      42                 :          0 : void ssb_chipco_set_clockmode(struct ssb_chipcommon *cc,
      43                 :            :                               enum ssb_clkmode mode)
      44                 :            : {
      45                 :          0 :         struct ssb_device *ccdev = cc->dev;
      46                 :          0 :         struct ssb_bus *bus;
      47                 :          0 :         u32 tmp;
      48                 :            : 
      49         [ #  # ]:          0 :         if (!ccdev)
      50                 :            :                 return;
      51                 :          0 :         bus = ccdev->bus;
      52                 :            : 
      53                 :            :         /* We support SLOW only on 6..9 */
      54   [ #  #  #  # ]:          0 :         if (ccdev->id.revision >= 10 && mode == SSB_CLKMODE_SLOW)
      55                 :          0 :                 mode = SSB_CLKMODE_DYNAMIC;
      56                 :            : 
      57         [ #  # ]:          0 :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU)
      58                 :            :                 return; /* PMU controls clockmode, separated function needed */
      59         [ #  # ]:          0 :         WARN_ON(ccdev->id.revision >= 20);
      60                 :            : 
      61                 :            :         /* chipcommon cores prior to rev6 don't support dynamic clock control */
      62         [ #  # ]:          0 :         if (ccdev->id.revision < 6)
      63                 :            :                 return;
      64                 :            : 
      65                 :            :         /* ChipCommon cores rev10+ need testing */
      66         [ #  # ]:          0 :         if (ccdev->id.revision >= 10)
      67                 :            :                 return;
      68                 :            : 
      69         [ #  # ]:          0 :         if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
      70                 :            :                 return;
      71                 :            : 
      72   [ #  #  #  # ]:          0 :         switch (mode) {
      73                 :          0 :         case SSB_CLKMODE_SLOW: /* For revs 6..9 only */
      74                 :          0 :                 tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
      75                 :          0 :                 tmp |= SSB_CHIPCO_SLOWCLKCTL_FSLOW;
      76                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
      77                 :            :                 break;
      78                 :            :         case SSB_CLKMODE_FAST:
      79                 :          0 :                 if (ccdev->id.revision < 10) {
      80                 :          0 :                         ssb_pci_xtal(bus, SSB_GPIO_XTAL, 1); /* Force crystal on */
      81                 :          0 :                         tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
      82                 :          0 :                         tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW;
      83                 :          0 :                         tmp |= SSB_CHIPCO_SLOWCLKCTL_IPLL;
      84                 :          0 :                         chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
      85                 :            :                 } else {
      86                 :            :                         chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
      87                 :            :                                 (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) |
      88                 :            :                                  SSB_CHIPCO_SYSCLKCTL_FORCEHT));
      89                 :            :                         /* udelay(150); TODO: not available in early init */
      90                 :            :                 }
      91                 :            :                 break;
      92                 :            :         case SSB_CLKMODE_DYNAMIC:
      93                 :          0 :                 if (ccdev->id.revision < 10) {
      94                 :          0 :                         tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
      95                 :          0 :                         tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW;
      96                 :          0 :                         tmp &= ~SSB_CHIPCO_SLOWCLKCTL_IPLL;
      97                 :          0 :                         tmp &= ~SSB_CHIPCO_SLOWCLKCTL_ENXTAL;
      98         [ #  # ]:          0 :                         if ((tmp & SSB_CHIPCO_SLOWCLKCTL_SRC) !=
      99                 :            :                             SSB_CHIPCO_SLOWCLKCTL_SRC_XTAL)
     100                 :          0 :                                 tmp |= SSB_CHIPCO_SLOWCLKCTL_ENXTAL;
     101                 :          0 :                         chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
     102                 :            : 
     103                 :            :                         /* For dynamic control, we have to release our xtal_pu
     104                 :            :                          * "force on" */
     105         [ #  # ]:          0 :                         if (tmp & SSB_CHIPCO_SLOWCLKCTL_ENXTAL)
     106                 :          0 :                                 ssb_pci_xtal(bus, SSB_GPIO_XTAL, 0);
     107                 :            :                 } else {
     108                 :            :                         chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
     109                 :            :                                 (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) &
     110                 :            :                                  ~SSB_CHIPCO_SYSCLKCTL_FORCEHT));
     111                 :            :                 }
     112                 :            :                 break;
     113                 :            :         default:
     114                 :          0 :                 WARN_ON(1);
     115                 :            :         }
     116                 :            : }
     117                 :            : 
     118                 :            : /* Get the Slow Clock Source */
     119                 :            : static enum ssb_clksrc chipco_pctl_get_slowclksrc(struct ssb_chipcommon *cc)
     120                 :            : {
     121                 :            :         struct ssb_bus *bus = cc->dev->bus;
     122                 :            :         u32 uninitialized_var(tmp);
     123                 :            : 
     124                 :            :         if (cc->dev->id.revision < 6) {
     125                 :            :                 if (bus->bustype == SSB_BUSTYPE_SSB ||
     126                 :            :                     bus->bustype == SSB_BUSTYPE_PCMCIA)
     127                 :            :                         return SSB_CHIPCO_CLKSRC_XTALOS;
     128                 :            :                 if (bus->bustype == SSB_BUSTYPE_PCI) {
     129                 :            :                         pci_read_config_dword(bus->host_pci, SSB_GPIO_OUT, &tmp);
     130                 :            :                         if (tmp & 0x10)
     131                 :            :                                 return SSB_CHIPCO_CLKSRC_PCI;
     132                 :            :                         return SSB_CHIPCO_CLKSRC_XTALOS;
     133                 :            :                 }
     134                 :            :         }
     135                 :            :         if (cc->dev->id.revision < 10) {
     136                 :            :                 tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
     137                 :            :                 tmp &= 0x7;
     138                 :            :                 if (tmp == 0)
     139                 :            :                         return SSB_CHIPCO_CLKSRC_LOPWROS;
     140                 :            :                 if (tmp == 1)
     141                 :            :                         return SSB_CHIPCO_CLKSRC_XTALOS;
     142                 :            :                 if (tmp == 2)
     143                 :            :                         return SSB_CHIPCO_CLKSRC_PCI;
     144                 :            :         }
     145                 :            : 
     146                 :            :         return SSB_CHIPCO_CLKSRC_XTALOS;
     147                 :            : }
     148                 :            : 
     149                 :            : /* Get maximum or minimum (depending on get_max flag) slowclock frequency. */
     150                 :          0 : static int chipco_pctl_clockfreqlimit(struct ssb_chipcommon *cc, int get_max)
     151                 :            : {
     152                 :          0 :         int uninitialized_var(limit);
     153                 :          0 :         enum ssb_clksrc clocksrc;
     154                 :          0 :         int divisor = 1;
     155                 :          0 :         u32 tmp;
     156                 :            : 
     157                 :          0 :         clocksrc = chipco_pctl_get_slowclksrc(cc);
     158         [ #  # ]:          0 :         if (cc->dev->id.revision < 6) {
     159      [ #  #  # ]:          0 :                 switch (clocksrc) {
     160                 :            :                 case SSB_CHIPCO_CLKSRC_PCI:
     161                 :            :                         divisor = 64;
     162                 :            :                         break;
     163                 :          0 :                 case SSB_CHIPCO_CLKSRC_XTALOS:
     164                 :          0 :                         divisor = 32;
     165                 :          0 :                         break;
     166                 :            :                 default:
     167                 :          0 :                         WARN_ON(1);
     168                 :            :                 }
     169         [ #  # ]:          0 :         } else if (cc->dev->id.revision < 10) {
     170         [ #  # ]:          0 :                 switch (clocksrc) {
     171                 :            :                 case SSB_CHIPCO_CLKSRC_LOPWROS:
     172                 :            :                         break;
     173                 :          0 :                 case SSB_CHIPCO_CLKSRC_XTALOS:
     174                 :            :                 case SSB_CHIPCO_CLKSRC_PCI:
     175                 :          0 :                         tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
     176                 :          0 :                         divisor = (tmp >> 16) + 1;
     177                 :          0 :                         divisor *= 4;
     178                 :          0 :                         break;
     179                 :            :                 }
     180                 :            :         } else {
     181                 :          0 :                 tmp = chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL);
     182                 :          0 :                 divisor = (tmp >> 16) + 1;
     183                 :          0 :                 divisor *= 4;
     184                 :            :         }
     185                 :            : 
     186   [ #  #  #  # ]:          0 :         switch (clocksrc) {
     187                 :          0 :         case SSB_CHIPCO_CLKSRC_LOPWROS:
     188         [ #  # ]:          0 :                 if (get_max)
     189                 :            :                         limit = 43000;
     190                 :            :                 else
     191                 :          0 :                         limit = 25000;
     192                 :            :                 break;
     193                 :          0 :         case SSB_CHIPCO_CLKSRC_XTALOS:
     194         [ #  # ]:          0 :                 if (get_max)
     195                 :            :                         limit = 20200000;
     196                 :            :                 else
     197                 :          0 :                         limit = 19800000;
     198                 :            :                 break;
     199                 :          0 :         case SSB_CHIPCO_CLKSRC_PCI:
     200         [ #  # ]:          0 :                 if (get_max)
     201                 :            :                         limit = 34000000;
     202                 :            :                 else
     203                 :          0 :                         limit = 25000000;
     204                 :            :                 break;
     205                 :            :         }
     206                 :          0 :         limit /= divisor;
     207                 :            : 
     208                 :          0 :         return limit;
     209                 :            : }
     210                 :            : 
     211                 :          0 : static void chipco_powercontrol_init(struct ssb_chipcommon *cc)
     212                 :            : {
     213                 :          0 :         struct ssb_bus *bus = cc->dev->bus;
     214                 :            : 
     215         [ #  # ]:          0 :         if (bus->chip_id == 0x4321) {
     216         [ #  # ]:          0 :                 if (bus->chip_rev == 0)
     217                 :          0 :                         chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0x3A4);
     218         [ #  # ]:          0 :                 else if (bus->chip_rev == 1)
     219                 :          0 :                         chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0xA4);
     220                 :            :         }
     221                 :            : 
     222         [ #  # ]:          0 :         if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
     223                 :            :                 return;
     224                 :            : 
     225         [ #  # ]:          0 :         if (cc->dev->id.revision >= 10) {
     226                 :            :                 /* Set Idle Power clock rate to 1Mhz */
     227                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
     228                 :            :                                (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) &
     229                 :            :                                 0x0000FFFF) | 0x00040000);
     230                 :            :         } else {
     231                 :          0 :                 int maxfreq;
     232                 :            : 
     233                 :          0 :                 maxfreq = chipco_pctl_clockfreqlimit(cc, 1);
     234                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_PLLONDELAY,
     235                 :            :                                (maxfreq * 150 + 999999) / 1000000);
     236                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_FREFSELDELAY,
     237                 :            :                                (maxfreq * 15 + 999999) / 1000000);
     238                 :            :         }
     239                 :            : }
     240                 :            : 
     241                 :            : /* http://bcm-v4.sipsolutions.net/802.11/PmuFastPwrupDelay */
     242                 :          0 : static u16 pmu_fast_powerup_delay(struct ssb_chipcommon *cc)
     243                 :            : {
     244                 :          0 :         struct ssb_bus *bus = cc->dev->bus;
     245                 :            : 
     246                 :          0 :         switch (bus->chip_id) {
     247                 :            :         case 0x4312:
     248                 :            :         case 0x4322:
     249                 :            :         case 0x4328:
     250                 :            :                 return 7000;
     251                 :          0 :         case 0x4325:
     252                 :            :                 /* TODO: */
     253                 :            :         default:
     254                 :          0 :                 return 15000;
     255                 :            :         }
     256                 :            : }
     257                 :            : 
     258                 :            : /* http://bcm-v4.sipsolutions.net/802.11/ClkctlFastPwrupDelay */
     259                 :          0 : static void calc_fast_powerup_delay(struct ssb_chipcommon *cc)
     260                 :            : {
     261                 :          0 :         struct ssb_bus *bus = cc->dev->bus;
     262                 :          0 :         int minfreq;
     263                 :          0 :         unsigned int tmp;
     264                 :          0 :         u32 pll_on_delay;
     265                 :            : 
     266         [ #  # ]:          0 :         if (bus->bustype != SSB_BUSTYPE_PCI)
     267                 :            :                 return;
     268                 :            : 
     269         [ #  # ]:          0 :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
     270         [ #  # ]:          0 :                 cc->fast_pwrup_delay = pmu_fast_powerup_delay(cc);
     271                 :          0 :                 return;
     272                 :            :         }
     273                 :            : 
     274         [ #  # ]:          0 :         if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
     275                 :            :                 return;
     276                 :            : 
     277                 :          0 :         minfreq = chipco_pctl_clockfreqlimit(cc, 0);
     278                 :          0 :         pll_on_delay = chipco_read32(cc, SSB_CHIPCO_PLLONDELAY);
     279                 :          0 :         tmp = (((pll_on_delay + 2) * 1000000) + (minfreq - 1)) / minfreq;
     280         [ #  # ]:          0 :         WARN_ON(tmp & ~0xFFFF);
     281                 :            : 
     282                 :          0 :         cc->fast_pwrup_delay = tmp;
     283                 :            : }
     284                 :            : 
     285                 :            : static u32 ssb_chipco_alp_clock(struct ssb_chipcommon *cc)
     286                 :            : {
     287                 :            :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU)
     288                 :            :                 return ssb_pmu_get_alp_clock(cc);
     289                 :            : 
     290                 :            :         return 20000000;
     291                 :            : }
     292                 :            : 
     293                 :          0 : static u32 ssb_chipco_watchdog_get_max_timer(struct ssb_chipcommon *cc)
     294                 :            : {
     295                 :          0 :         u32 nb;
     296                 :            : 
     297                 :          0 :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
     298   [ #  #  #  # ]:          0 :                 if (cc->dev->id.revision < 26)
     299                 :            :                         nb = 16;
     300                 :            :                 else
     301   [ #  #  #  # ]:          0 :                         nb = (cc->dev->id.revision >= 37) ? 32 : 24;
     302                 :            :         } else {
     303                 :            :                 nb = 28;
     304                 :            :         }
     305                 :            :         if (nb == 32)
     306                 :            :                 return 0xffffffff;
     307                 :            :         else
     308                 :          0 :                 return (1 << nb) - 1;
     309                 :            : }
     310                 :            : 
     311                 :          0 : u32 ssb_chipco_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks)
     312                 :            : {
     313         [ #  # ]:          0 :         struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
     314                 :            : 
     315         [ #  # ]:          0 :         if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
     316                 :            :                 return 0;
     317                 :            : 
     318                 :          0 :         return ssb_chipco_watchdog_timer_set(cc, ticks);
     319                 :            : }
     320                 :            : 
     321                 :          0 : u32 ssb_chipco_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms)
     322                 :            : {
     323         [ #  # ]:          0 :         struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
     324                 :          0 :         u32 ticks;
     325                 :            : 
     326         [ #  # ]:          0 :         if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
     327                 :            :                 return 0;
     328                 :            : 
     329                 :          0 :         ticks = ssb_chipco_watchdog_timer_set(cc, cc->ticks_per_ms * ms);
     330                 :          0 :         return ticks / cc->ticks_per_ms;
     331                 :            : }
     332                 :            : 
     333                 :          0 : static int ssb_chipco_watchdog_ticks_per_ms(struct ssb_chipcommon *cc)
     334                 :            : {
     335                 :          0 :         struct ssb_bus *bus = cc->dev->bus;
     336                 :            : 
     337                 :          0 :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
     338                 :            :                         /* based on 32KHz ILP clock */
     339                 :            :                         return 32;
     340                 :            :         } else {
     341         [ #  # ]:          0 :                 if (cc->dev->id.revision < 18)
     342                 :          0 :                         return ssb_clockspeed(bus) / 1000;
     343                 :            :                 else
     344                 :            :                         return ssb_chipco_alp_clock(cc) / 1000;
     345                 :            :         }
     346                 :            : }
     347                 :            : 
     348                 :          0 : void ssb_chipcommon_init(struct ssb_chipcommon *cc)
     349                 :            : {
     350         [ #  # ]:          0 :         if (!cc->dev)
     351                 :            :                 return; /* We don't have a ChipCommon */
     352                 :            : 
     353         [ #  # ]:          0 :         spin_lock_init(&cc->gpio_lock);
     354                 :            : 
     355         [ #  # ]:          0 :         if (cc->dev->id.revision >= 11)
     356                 :          0 :                 cc->status = chipco_read32(cc, SSB_CHIPCO_CHIPSTAT);
     357                 :          0 :         dev_dbg(cc->dev->dev, "chipcommon status is 0x%x\n", cc->status);
     358                 :            : 
     359         [ #  # ]:          0 :         if (cc->dev->id.revision >= 20) {
     360                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_GPIOPULLUP, 0);
     361                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_GPIOPULLDOWN, 0);
     362                 :            :         }
     363                 :            : 
     364                 :          0 :         ssb_pmu_init(cc);
     365                 :          0 :         chipco_powercontrol_init(cc);
     366                 :          0 :         ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
     367                 :          0 :         calc_fast_powerup_delay(cc);
     368                 :            : 
     369         [ #  # ]:          0 :         if (cc->dev->bus->bustype == SSB_BUSTYPE_SSB) {
     370         [ #  # ]:          0 :                 cc->ticks_per_ms = ssb_chipco_watchdog_ticks_per_ms(cc);
     371         [ #  # ]:          0 :                 cc->max_timer_ms = ssb_chipco_watchdog_get_max_timer(cc) / cc->ticks_per_ms;
     372                 :            :         }
     373                 :            : }
     374                 :            : 
     375                 :          0 : void ssb_chipco_suspend(struct ssb_chipcommon *cc)
     376                 :            : {
     377         [ #  # ]:          0 :         if (!cc->dev)
     378                 :            :                 return;
     379                 :          0 :         ssb_chipco_set_clockmode(cc, SSB_CLKMODE_SLOW);
     380                 :            : }
     381                 :            : 
     382                 :          0 : void ssb_chipco_resume(struct ssb_chipcommon *cc)
     383                 :            : {
     384         [ #  # ]:          0 :         if (!cc->dev)
     385                 :            :                 return;
     386                 :          0 :         chipco_powercontrol_init(cc);
     387                 :          0 :         ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
     388                 :            : }
     389                 :            : 
     390                 :            : /* Get the processor clock */
     391                 :          0 : void ssb_chipco_get_clockcpu(struct ssb_chipcommon *cc,
     392                 :            :                              u32 *plltype, u32 *n, u32 *m)
     393                 :            : {
     394                 :          0 :         *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
     395                 :          0 :         *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
     396      [ #  #  # ]:          0 :         switch (*plltype) {
     397                 :          0 :         case SSB_PLLTYPE_2:
     398                 :            :         case SSB_PLLTYPE_4:
     399                 :            :         case SSB_PLLTYPE_6:
     400                 :            :         case SSB_PLLTYPE_7:
     401                 :          0 :                 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
     402                 :          0 :                 break;
     403                 :          0 :         case SSB_PLLTYPE_3:
     404                 :            :                 /* 5350 uses m2 to control mips */
     405                 :          0 :                 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
     406                 :          0 :                 break;
     407                 :          0 :         default:
     408                 :          0 :                 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
     409                 :          0 :                 break;
     410                 :            :         }
     411                 :          0 : }
     412                 :            : 
     413                 :            : /* Get the bus clock */
     414                 :          0 : void ssb_chipco_get_clockcontrol(struct ssb_chipcommon *cc,
     415                 :            :                                  u32 *plltype, u32 *n, u32 *m)
     416                 :            : {
     417                 :          0 :         *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
     418                 :          0 :         *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
     419      [ #  #  # ]:          0 :         switch (*plltype) {
     420                 :          0 :         case SSB_PLLTYPE_6: /* 100/200 or 120/240 only */
     421                 :          0 :                 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
     422                 :          0 :                 break;
     423                 :          0 :         case SSB_PLLTYPE_3: /* 25Mhz, 2 dividers */
     424         [ #  # ]:          0 :                 if (cc->dev->bus->chip_id != 0x5365) {
     425                 :          0 :                         *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
     426                 :          0 :                         break;
     427                 :            :                 }
     428                 :            :                 /* Fall through */
     429                 :            :         default:
     430                 :          0 :                 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
     431                 :            :         }
     432                 :          0 : }
     433                 :            : 
     434                 :          0 : void ssb_chipco_timing_init(struct ssb_chipcommon *cc,
     435                 :            :                             unsigned long ns)
     436                 :            : {
     437                 :          0 :         struct ssb_device *dev = cc->dev;
     438                 :          0 :         struct ssb_bus *bus = dev->bus;
     439                 :          0 :         u32 tmp;
     440                 :            : 
     441                 :            :         /* set register for external IO to control LED. */
     442                 :          0 :         chipco_write32(cc, SSB_CHIPCO_PROG_CFG, 0x11);
     443                 :          0 :         tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;              /* Waitcount-3 = 10ns */
     444                 :          0 :         tmp |= DIV_ROUND_UP(40, ns) << SSB_PROG_WCNT_1_SHIFT;     /* Waitcount-1 = 40ns */
     445                 :          0 :         tmp |= DIV_ROUND_UP(240, ns);                           /* Waitcount-0 = 240ns */
     446                 :          0 :         chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp);       /* 0x01020a0c for a 100Mhz clock */
     447                 :            : 
     448                 :            :         /* Set timing for the flash */
     449                 :          0 :         tmp = DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_3_SHIFT;     /* Waitcount-3 = 10nS */
     450                 :          0 :         tmp |= DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_1_SHIFT;    /* Waitcount-1 = 10nS */
     451                 :          0 :         tmp |= DIV_ROUND_UP(120, ns);                           /* Waitcount-0 = 120nS */
     452         [ #  # ]:          0 :         if ((bus->chip_id == 0x5365) ||
     453         [ #  # ]:          0 :             (dev->id.revision < 9))
     454                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_FLASH_WAITCNT, tmp);
     455         [ #  # ]:          0 :         if ((bus->chip_id == 0x5365) ||
     456         [ #  # ]:          0 :             (dev->id.revision < 9) ||
     457         [ #  # ]:          0 :             ((bus->chip_id == 0x5350) && (bus->chip_rev == 0)))
     458                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_PCMCIA_MEMWAIT, tmp);
     459                 :            : 
     460         [ #  # ]:          0 :         if (bus->chip_id == 0x5350) {
     461                 :            :                 /* Enable EXTIF */
     462                 :          0 :                 tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;        /* Waitcount-3 = 10ns */
     463                 :          0 :                 tmp |= DIV_ROUND_UP(20, ns) << SSB_PROG_WCNT_2_SHIFT;  /* Waitcount-2 = 20ns */
     464                 :          0 :                 tmp |= DIV_ROUND_UP(100, ns) << SSB_PROG_WCNT_1_SHIFT; /* Waitcount-1 = 100ns */
     465                 :          0 :                 tmp |= DIV_ROUND_UP(120, ns);                     /* Waitcount-0 = 120ns */
     466                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp); /* 0x01020a0c for a 100Mhz clock */
     467                 :            :         }
     468                 :          0 : }
     469                 :            : 
     470                 :            : /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */
     471                 :          0 : u32 ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks)
     472                 :            : {
     473                 :          0 :         u32 maxt;
     474                 :          0 :         enum ssb_clkmode clkmode;
     475                 :            : 
     476         [ #  # ]:          0 :         maxt = ssb_chipco_watchdog_get_max_timer(cc);
     477         [ #  # ]:          0 :         if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
     478         [ #  # ]:          0 :                 if (ticks == 1)
     479                 :            :                         ticks = 2;
     480                 :          0 :                 else if (ticks > maxt)
     481                 :            :                         ticks = maxt;
     482                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_PMU_WATCHDOG, ticks);
     483                 :            :         } else {
     484         [ #  # ]:          0 :                 clkmode = ticks ? SSB_CLKMODE_FAST : SSB_CLKMODE_DYNAMIC;
     485                 :          0 :                 ssb_chipco_set_clockmode(cc, clkmode);
     486                 :          0 :                 if (ticks > maxt)
     487                 :            :                         ticks = maxt;
     488                 :            :                 /* instant NMI */
     489                 :          0 :                 chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks);
     490                 :            :         }
     491                 :          0 :         return ticks;
     492                 :            : }
     493                 :            : 
     494                 :          0 : void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value)
     495                 :            : {
     496                 :          0 :         chipco_write32_masked(cc, SSB_CHIPCO_IRQMASK, mask, value);
     497                 :          0 : }
     498                 :            : 
     499                 :          0 : u32 ssb_chipco_irq_status(struct ssb_chipcommon *cc, u32 mask)
     500                 :            : {
     501                 :          0 :         return chipco_read32(cc, SSB_CHIPCO_IRQSTAT) & mask;
     502                 :            : }
     503                 :            : 
     504                 :          0 : u32 ssb_chipco_gpio_in(struct ssb_chipcommon *cc, u32 mask)
     505                 :            : {
     506                 :          0 :         return chipco_read32(cc, SSB_CHIPCO_GPIOIN) & mask;
     507                 :            : }
     508                 :            : 
     509                 :          0 : u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value)
     510                 :            : {
     511                 :          0 :         unsigned long flags;
     512                 :          0 :         u32 res = 0;
     513                 :            : 
     514                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     515                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
     516                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     517                 :            : 
     518                 :          0 :         return res;
     519                 :            : }
     520                 :            : 
     521                 :          0 : u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value)
     522                 :            : {
     523                 :          0 :         unsigned long flags;
     524                 :          0 :         u32 res = 0;
     525                 :            : 
     526                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     527                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
     528                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     529                 :            : 
     530                 :          0 :         return res;
     531                 :            : }
     532                 :            : 
     533                 :          0 : u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value)
     534                 :            : {
     535                 :          0 :         unsigned long flags;
     536                 :          0 :         u32 res = 0;
     537                 :            : 
     538                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     539                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
     540                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     541                 :            : 
     542                 :          0 :         return res;
     543                 :            : }
     544                 :            : EXPORT_SYMBOL(ssb_chipco_gpio_control);
     545                 :            : 
     546                 :          0 : u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value)
     547                 :            : {
     548                 :          0 :         unsigned long flags;
     549                 :          0 :         u32 res = 0;
     550                 :            : 
     551                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     552                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
     553                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     554                 :            : 
     555                 :          0 :         return res;
     556                 :            : }
     557                 :            : 
     558                 :          0 : u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value)
     559                 :            : {
     560                 :          0 :         unsigned long flags;
     561                 :          0 :         u32 res = 0;
     562                 :            : 
     563                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     564                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
     565                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     566                 :            : 
     567                 :          0 :         return res;
     568                 :            : }
     569                 :            : 
     570                 :          0 : u32 ssb_chipco_gpio_pullup(struct ssb_chipcommon *cc, u32 mask, u32 value)
     571                 :            : {
     572                 :          0 :         unsigned long flags;
     573                 :          0 :         u32 res = 0;
     574                 :            : 
     575         [ #  # ]:          0 :         if (cc->dev->id.revision < 20)
     576                 :            :                 return 0xffffffff;
     577                 :            : 
     578                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     579                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLUP, mask, value);
     580                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     581                 :            : 
     582                 :          0 :         return res;
     583                 :            : }
     584                 :            : 
     585                 :          0 : u32 ssb_chipco_gpio_pulldown(struct ssb_chipcommon *cc, u32 mask, u32 value)
     586                 :            : {
     587                 :          0 :         unsigned long flags;
     588                 :          0 :         u32 res = 0;
     589                 :            : 
     590         [ #  # ]:          0 :         if (cc->dev->id.revision < 20)
     591                 :            :                 return 0xffffffff;
     592                 :            : 
     593                 :          0 :         spin_lock_irqsave(&cc->gpio_lock, flags);
     594                 :          0 :         res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLDOWN, mask, value);
     595                 :          0 :         spin_unlock_irqrestore(&cc->gpio_lock, flags);
     596                 :            : 
     597                 :          0 :         return res;
     598                 :            : }
     599                 :            : 
     600                 :            : #ifdef CONFIG_SSB_SERIAL
     601                 :            : int ssb_chipco_serial_init(struct ssb_chipcommon *cc,
     602                 :            :                            struct ssb_serial_port *ports)
     603                 :            : {
     604                 :            :         struct ssb_bus *bus = cc->dev->bus;
     605                 :            :         int nr_ports = 0;
     606                 :            :         u32 plltype;
     607                 :            :         unsigned int irq;
     608                 :            :         u32 baud_base, div;
     609                 :            :         u32 i, n;
     610                 :            :         unsigned int ccrev = cc->dev->id.revision;
     611                 :            : 
     612                 :            :         plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
     613                 :            :         irq = ssb_mips_irq(cc->dev);
     614                 :            : 
     615                 :            :         if (plltype == SSB_PLLTYPE_1) {
     616                 :            :                 /* PLL clock */
     617                 :            :                 baud_base = ssb_calc_clock_rate(plltype,
     618                 :            :                                                 chipco_read32(cc, SSB_CHIPCO_CLOCK_N),
     619                 :            :                                                 chipco_read32(cc, SSB_CHIPCO_CLOCK_M2));
     620                 :            :                 div = 1;
     621                 :            :         } else {
     622                 :            :                 if (ccrev == 20) {
     623                 :            :                         /* BCM5354 uses constant 25MHz clock */
     624                 :            :                         baud_base = 25000000;
     625                 :            :                         div = 48;
     626                 :            :                         /* Set the override bit so we don't divide it */
     627                 :            :                         chipco_write32(cc, SSB_CHIPCO_CORECTL,
     628                 :            :                                        chipco_read32(cc, SSB_CHIPCO_CORECTL)
     629                 :            :                                        | SSB_CHIPCO_CORECTL_UARTCLK0);
     630                 :            :                 } else if ((ccrev >= 11) && (ccrev != 15)) {
     631                 :            :                         baud_base = ssb_chipco_alp_clock(cc);
     632                 :            :                         div = 1;
     633                 :            :                         if (ccrev >= 21) {
     634                 :            :                                 /* Turn off UART clock before switching clocksource. */
     635                 :            :                                 chipco_write32(cc, SSB_CHIPCO_CORECTL,
     636                 :            :                                                chipco_read32(cc, SSB_CHIPCO_CORECTL)
     637                 :            :                                                & ~SSB_CHIPCO_CORECTL_UARTCLKEN);
     638                 :            :                         }
     639                 :            :                         /* Set the override bit so we don't divide it */
     640                 :            :                         chipco_write32(cc, SSB_CHIPCO_CORECTL,
     641                 :            :                                        chipco_read32(cc, SSB_CHIPCO_CORECTL)
     642                 :            :                                        | SSB_CHIPCO_CORECTL_UARTCLK0);
     643                 :            :                         if (ccrev >= 21) {
     644                 :            :                                 /* Re-enable the UART clock. */
     645                 :            :                                 chipco_write32(cc, SSB_CHIPCO_CORECTL,
     646                 :            :                                                chipco_read32(cc, SSB_CHIPCO_CORECTL)
     647                 :            :                                                | SSB_CHIPCO_CORECTL_UARTCLKEN);
     648                 :            :                         }
     649                 :            :                 } else if (ccrev >= 3) {
     650                 :            :                         /* Internal backplane clock */
     651                 :            :                         baud_base = ssb_clockspeed(bus);
     652                 :            :                         div = chipco_read32(cc, SSB_CHIPCO_CLKDIV)
     653                 :            :                               & SSB_CHIPCO_CLKDIV_UART;
     654                 :            :                 } else {
     655                 :            :                         /* Fixed internal backplane clock */
     656                 :            :                         baud_base = 88000000;
     657                 :            :                         div = 48;
     658                 :            :                 }
     659                 :            : 
     660                 :            :                 /* Clock source depends on strapping if UartClkOverride is unset */
     661                 :            :                 if ((ccrev > 0) &&
     662                 :            :                     !(chipco_read32(cc, SSB_CHIPCO_CORECTL) & SSB_CHIPCO_CORECTL_UARTCLK0)) {
     663                 :            :                         if ((cc->capabilities & SSB_CHIPCO_CAP_UARTCLK) ==
     664                 :            :                             SSB_CHIPCO_CAP_UARTCLK_INT) {
     665                 :            :                                 /* Internal divided backplane clock */
     666                 :            :                                 baud_base /= div;
     667                 :            :                         } else {
     668                 :            :                                 /* Assume external clock of 1.8432 MHz */
     669                 :            :                                 baud_base = 1843200;
     670                 :            :                         }
     671                 :            :                 }
     672                 :            :         }
     673                 :            : 
     674                 :            :         /* Determine the registers of the UARTs */
     675                 :            :         n = (cc->capabilities & SSB_CHIPCO_CAP_NRUART);
     676                 :            :         for (i = 0; i < n; i++) {
     677                 :            :                 void __iomem *cc_mmio;
     678                 :            :                 void __iomem *uart_regs;
     679                 :            : 
     680                 :            :                 cc_mmio = cc->dev->bus->mmio + (cc->dev->core_index * SSB_CORE_SIZE);
     681                 :            :                 uart_regs = cc_mmio + SSB_CHIPCO_UART0_DATA;
     682                 :            :                 /* Offset changed at after rev 0 */
     683                 :            :                 if (ccrev == 0)
     684                 :            :                         uart_regs += (i * 8);
     685                 :            :                 else
     686                 :            :                         uart_regs += (i * 256);
     687                 :            : 
     688                 :            :                 nr_ports++;
     689                 :            :                 ports[i].regs = uart_regs;
     690                 :            :                 ports[i].irq = irq;
     691                 :            :                 ports[i].baud_base = baud_base;
     692                 :            :                 ports[i].reg_shift = 0;
     693                 :            :         }
     694                 :            : 
     695                 :            :         return nr_ports;
     696                 :            : }
     697                 :            : #endif /* CONFIG_SSB_SERIAL */

Generated by: LCOV version 1.14