1 /*
2 * Marvell 88SE64xx hardware specific
3 *
4 * Copyright 2007 Red Hat, Inc.
5 * Copyright 2008 Marvell. <kewei@marvell.com>
6 * Copyright 2009-2011 Marvell. <yuxiangl@marvell.com>
7 *
8 * This file is licensed under GPLv2.
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; version 2 of the
13 * License.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
23 * USA
24 */
25
26 #include "mv_sas.h"
27 #include "mv_64xx.h"
28 #include "mv_chips.h"
29
mvs_64xx_detect_porttype(struct mvs_info * mvi,int i)30 static void mvs_64xx_detect_porttype(struct mvs_info *mvi, int i)
31 {
32 void __iomem *regs = mvi->regs;
33 u32 reg;
34 struct mvs_phy *phy = &mvi->phy[i];
35
36 reg = mr32(MVS_GBL_PORT_TYPE);
37 phy->phy_type &= ~(PORT_TYPE_SAS | PORT_TYPE_SATA);
38 if (reg & MODE_SAS_SATA & (1 << i))
39 phy->phy_type |= PORT_TYPE_SAS;
40 else
41 phy->phy_type |= PORT_TYPE_SATA;
42 }
43
mvs_64xx_enable_xmt(struct mvs_info * mvi,int phy_id)44 static void __devinit mvs_64xx_enable_xmt(struct mvs_info *mvi, int phy_id)
45 {
46 void __iomem *regs = mvi->regs;
47 u32 tmp;
48
49 tmp = mr32(MVS_PCS);
50 if (mvi->chip->n_phy <= MVS_SOC_PORTS)
51 tmp |= 1 << (phy_id + PCS_EN_PORT_XMT_SHIFT);
52 else
53 tmp |= 1 << (phy_id + PCS_EN_PORT_XMT_SHIFT2);
54 mw32(MVS_PCS, tmp);
55 }
56
mvs_64xx_phy_hacks(struct mvs_info * mvi)57 static void __devinit mvs_64xx_phy_hacks(struct mvs_info *mvi)
58 {
59 void __iomem *regs = mvi->regs;
60 int i;
61
62 mvs_phy_hacks(mvi);
63
64 if (!(mvi->flags & MVF_FLAG_SOC)) {
65 for (i = 0; i < MVS_SOC_PORTS; i++) {
66 mvs_write_port_vsr_addr(mvi, i, VSR_PHY_MODE8);
67 mvs_write_port_vsr_data(mvi, i, 0x2F0);
68 }
69 } else {
70 /* disable auto port detection */
71 mw32(MVS_GBL_PORT_TYPE, 0);
72 for (i = 0; i < mvi->chip->n_phy; i++) {
73 mvs_write_port_vsr_addr(mvi, i, VSR_PHY_MODE7);
74 mvs_write_port_vsr_data(mvi, i, 0x90000000);
75 mvs_write_port_vsr_addr(mvi, i, VSR_PHY_MODE9);
76 mvs_write_port_vsr_data(mvi, i, 0x50f2);
77 mvs_write_port_vsr_addr(mvi, i, VSR_PHY_MODE11);
78 mvs_write_port_vsr_data(mvi, i, 0x0e);
79 }
80 }
81 }
82
mvs_64xx_stp_reset(struct mvs_info * mvi,u32 phy_id)83 static void mvs_64xx_stp_reset(struct mvs_info *mvi, u32 phy_id)
84 {
85 void __iomem *regs = mvi->regs;
86 u32 reg, tmp;
87
88 if (!(mvi->flags & MVF_FLAG_SOC)) {
89 if (phy_id < MVS_SOC_PORTS)
90 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL, ®);
91 else
92 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL2, ®);
93
94 } else
95 reg = mr32(MVS_PHY_CTL);
96
97 tmp = reg;
98 if (phy_id < MVS_SOC_PORTS)
99 tmp |= (1U << phy_id) << PCTL_LINK_OFFS;
100 else
101 tmp |= (1U << (phy_id - MVS_SOC_PORTS)) << PCTL_LINK_OFFS;
102
103 if (!(mvi->flags & MVF_FLAG_SOC)) {
104 if (phy_id < MVS_SOC_PORTS) {
105 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL, tmp);
106 mdelay(10);
107 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL, reg);
108 } else {
109 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL2, tmp);
110 mdelay(10);
111 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL2, reg);
112 }
113 } else {
114 mw32(MVS_PHY_CTL, tmp);
115 mdelay(10);
116 mw32(MVS_PHY_CTL, reg);
117 }
118 }
119
mvs_64xx_phy_reset(struct mvs_info * mvi,u32 phy_id,int hard)120 static void mvs_64xx_phy_reset(struct mvs_info *mvi, u32 phy_id, int hard)
121 {
122 u32 tmp;
123 tmp = mvs_read_port_irq_stat(mvi, phy_id);
124 tmp &= ~PHYEV_RDY_CH;
125 mvs_write_port_irq_stat(mvi, phy_id, tmp);
126 tmp = mvs_read_phy_ctl(mvi, phy_id);
127 if (hard == MVS_HARD_RESET)
128 tmp |= PHY_RST_HARD;
129 else if (hard == MVS_SOFT_RESET)
130 tmp |= PHY_RST;
131 mvs_write_phy_ctl(mvi, phy_id, tmp);
132 if (hard) {
133 do {
134 tmp = mvs_read_phy_ctl(mvi, phy_id);
135 } while (tmp & PHY_RST_HARD);
136 }
137 }
138
mvs_64xx_clear_srs_irq(struct mvs_info * mvi,u8 reg_set,u8 clear_all)139 void mvs_64xx_clear_srs_irq(struct mvs_info *mvi, u8 reg_set, u8 clear_all)
140 {
141 void __iomem *regs = mvi->regs;
142 u32 tmp;
143 if (clear_all) {
144 tmp = mr32(MVS_INT_STAT_SRS_0);
145 if (tmp) {
146 printk(KERN_DEBUG "check SRS 0 %08X.\n", tmp);
147 mw32(MVS_INT_STAT_SRS_0, tmp);
148 }
149 } else {
150 tmp = mr32(MVS_INT_STAT_SRS_0);
151 if (tmp & (1 << (reg_set % 32))) {
152 printk(KERN_DEBUG "register set 0x%x was stopped.\n",
153 reg_set);
154 mw32(MVS_INT_STAT_SRS_0, 1 << (reg_set % 32));
155 }
156 }
157 }
158
mvs_64xx_chip_reset(struct mvs_info * mvi)159 static int __devinit mvs_64xx_chip_reset(struct mvs_info *mvi)
160 {
161 void __iomem *regs = mvi->regs;
162 u32 tmp;
163 int i;
164
165 /* make sure interrupts are masked immediately (paranoia) */
166 mw32(MVS_GBL_CTL, 0);
167 tmp = mr32(MVS_GBL_CTL);
168
169 /* Reset Controller */
170 if (!(tmp & HBA_RST)) {
171 if (mvi->flags & MVF_PHY_PWR_FIX) {
172 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL, &tmp);
173 tmp &= ~PCTL_PWR_OFF;
174 tmp |= PCTL_PHY_DSBL;
175 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL, tmp);
176
177 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL2, &tmp);
178 tmp &= ~PCTL_PWR_OFF;
179 tmp |= PCTL_PHY_DSBL;
180 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL2, tmp);
181 }
182 }
183
184 /* make sure interrupts are masked immediately (paranoia) */
185 mw32(MVS_GBL_CTL, 0);
186 tmp = mr32(MVS_GBL_CTL);
187
188 /* Reset Controller */
189 if (!(tmp & HBA_RST)) {
190 /* global reset, incl. COMRESET/H_RESET_N (self-clearing) */
191 mw32_f(MVS_GBL_CTL, HBA_RST);
192 }
193
194 /* wait for reset to finish; timeout is just a guess */
195 i = 1000;
196 while (i-- > 0) {
197 msleep(10);
198
199 if (!(mr32(MVS_GBL_CTL) & HBA_RST))
200 break;
201 }
202 if (mr32(MVS_GBL_CTL) & HBA_RST) {
203 dev_printk(KERN_ERR, mvi->dev, "HBA reset failed\n");
204 return -EBUSY;
205 }
206 return 0;
207 }
208
mvs_64xx_phy_disable(struct mvs_info * mvi,u32 phy_id)209 static void mvs_64xx_phy_disable(struct mvs_info *mvi, u32 phy_id)
210 {
211 void __iomem *regs = mvi->regs;
212 u32 tmp;
213 if (!(mvi->flags & MVF_FLAG_SOC)) {
214 u32 offs;
215 if (phy_id < 4)
216 offs = PCR_PHY_CTL;
217 else {
218 offs = PCR_PHY_CTL2;
219 phy_id -= 4;
220 }
221 pci_read_config_dword(mvi->pdev, offs, &tmp);
222 tmp |= 1U << (PCTL_PHY_DSBL_OFFS + phy_id);
223 pci_write_config_dword(mvi->pdev, offs, tmp);
224 } else {
225 tmp = mr32(MVS_PHY_CTL);
226 tmp |= 1U << (PCTL_PHY_DSBL_OFFS + phy_id);
227 mw32(MVS_PHY_CTL, tmp);
228 }
229 }
230
mvs_64xx_phy_enable(struct mvs_info * mvi,u32 phy_id)231 static void mvs_64xx_phy_enable(struct mvs_info *mvi, u32 phy_id)
232 {
233 void __iomem *regs = mvi->regs;
234 u32 tmp;
235 if (!(mvi->flags & MVF_FLAG_SOC)) {
236 u32 offs;
237 if (phy_id < 4)
238 offs = PCR_PHY_CTL;
239 else {
240 offs = PCR_PHY_CTL2;
241 phy_id -= 4;
242 }
243 pci_read_config_dword(mvi->pdev, offs, &tmp);
244 tmp &= ~(1U << (PCTL_PHY_DSBL_OFFS + phy_id));
245 pci_write_config_dword(mvi->pdev, offs, tmp);
246 } else {
247 tmp = mr32(MVS_PHY_CTL);
248 tmp &= ~(1U << (PCTL_PHY_DSBL_OFFS + phy_id));
249 mw32(MVS_PHY_CTL, tmp);
250 }
251 }
252
mvs_64xx_init(struct mvs_info * mvi)253 static int __devinit mvs_64xx_init(struct mvs_info *mvi)
254 {
255 void __iomem *regs = mvi->regs;
256 int i;
257 u32 tmp, cctl;
258
259 if (mvi->pdev && mvi->pdev->revision == 0)
260 mvi->flags |= MVF_PHY_PWR_FIX;
261 if (!(mvi->flags & MVF_FLAG_SOC)) {
262 mvs_show_pcie_usage(mvi);
263 tmp = mvs_64xx_chip_reset(mvi);
264 if (tmp)
265 return tmp;
266 } else {
267 tmp = mr32(MVS_PHY_CTL);
268 tmp &= ~PCTL_PWR_OFF;
269 tmp |= PCTL_PHY_DSBL;
270 mw32(MVS_PHY_CTL, tmp);
271 }
272
273 /* Init Chip */
274 /* make sure RST is set; HBA_RST /should/ have done that for us */
275 cctl = mr32(MVS_CTL) & 0xFFFF;
276 if (cctl & CCTL_RST)
277 cctl &= ~CCTL_RST;
278 else
279 mw32_f(MVS_CTL, cctl | CCTL_RST);
280
281 if (!(mvi->flags & MVF_FLAG_SOC)) {
282 /* write to device control _AND_ device status register */
283 pci_read_config_dword(mvi->pdev, PCR_DEV_CTRL, &tmp);
284 tmp &= ~PRD_REQ_MASK;
285 tmp |= PRD_REQ_SIZE;
286 pci_write_config_dword(mvi->pdev, PCR_DEV_CTRL, tmp);
287
288 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL, &tmp);
289 tmp &= ~PCTL_PWR_OFF;
290 tmp &= ~PCTL_PHY_DSBL;
291 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL, tmp);
292
293 pci_read_config_dword(mvi->pdev, PCR_PHY_CTL2, &tmp);
294 tmp &= PCTL_PWR_OFF;
295 tmp &= ~PCTL_PHY_DSBL;
296 pci_write_config_dword(mvi->pdev, PCR_PHY_CTL2, tmp);
297 } else {
298 tmp = mr32(MVS_PHY_CTL);
299 tmp &= ~PCTL_PWR_OFF;
300 tmp |= PCTL_COM_ON;
301 tmp &= ~PCTL_PHY_DSBL;
302 tmp |= PCTL_LINK_RST;
303 mw32(MVS_PHY_CTL, tmp);
304 msleep(100);
305 tmp &= ~PCTL_LINK_RST;
306 mw32(MVS_PHY_CTL, tmp);
307 msleep(100);
308 }
309
310 /* reset control */
311 mw32(MVS_PCS, 0); /* MVS_PCS */
312 /* init phys */
313 mvs_64xx_phy_hacks(mvi);
314
315 tmp = mvs_cr32(mvi, CMD_PHY_MODE_21);
316 tmp &= 0x0000ffff;
317 tmp |= 0x00fa0000;
318 mvs_cw32(mvi, CMD_PHY_MODE_21, tmp);
319
320 /* enable auto port detection */
321 mw32(MVS_GBL_PORT_TYPE, MODE_AUTO_DET_EN);
322
323 mw32(MVS_CMD_LIST_LO, mvi->slot_dma);
324 mw32(MVS_CMD_LIST_HI, (mvi->slot_dma >> 16) >> 16);
325
326 mw32(MVS_RX_FIS_LO, mvi->rx_fis_dma);
327 mw32(MVS_RX_FIS_HI, (mvi->rx_fis_dma >> 16) >> 16);
328
329 mw32(MVS_TX_CFG, MVS_CHIP_SLOT_SZ);
330 mw32(MVS_TX_LO, mvi->tx_dma);
331 mw32(MVS_TX_HI, (mvi->tx_dma >> 16) >> 16);
332
333 mw32(MVS_RX_CFG, MVS_RX_RING_SZ);
334 mw32(MVS_RX_LO, mvi->rx_dma);
335 mw32(MVS_RX_HI, (mvi->rx_dma >> 16) >> 16);
336
337 for (i = 0; i < mvi->chip->n_phy; i++) {
338 /* set phy local SAS address */
339 /* should set little endian SAS address to 64xx chip */
340 mvs_set_sas_addr(mvi, i, PHYR_ADDR_LO, PHYR_ADDR_HI,
341 cpu_to_be64(mvi->phy[i].dev_sas_addr));
342
343 mvs_64xx_enable_xmt(mvi, i);
344
345 mvs_64xx_phy_reset(mvi, i, MVS_HARD_RESET);
346 msleep(500);
347 mvs_64xx_detect_porttype(mvi, i);
348 }
349 if (mvi->flags & MVF_FLAG_SOC) {
350 /* set select registers */
351 writel(0x0E008000, regs + 0x000);
352 writel(0x59000008, regs + 0x004);
353 writel(0x20, regs + 0x008);
354 writel(0x20, regs + 0x00c);
355 writel(0x20, regs + 0x010);
356 writel(0x20, regs + 0x014);
357 writel(0x20, regs + 0x018);
358 writel(0x20, regs + 0x01c);
359 }
360 for (i = 0; i < mvi->chip->n_phy; i++) {
361 /* clear phy int status */
362 tmp = mvs_read_port_irq_stat(mvi, i);
363 tmp &= ~PHYEV_SIG_FIS;
364 mvs_write_port_irq_stat(mvi, i, tmp);
365
366 /* set phy int mask */
367 tmp = PHYEV_RDY_CH | PHYEV_BROAD_CH | PHYEV_UNASSOC_FIS |
368 PHYEV_ID_DONE | PHYEV_DCDR_ERR | PHYEV_CRC_ERR |
369 PHYEV_DEC_ERR;
370 mvs_write_port_irq_mask(mvi, i, tmp);
371
372 msleep(100);
373 mvs_update_phyinfo(mvi, i, 1);
374 }
375
376 /* little endian for open address and command table, etc. */
377 cctl = mr32(MVS_CTL);
378 cctl |= CCTL_ENDIAN_CMD;
379 cctl |= CCTL_ENDIAN_DATA;
380 cctl &= ~CCTL_ENDIAN_OPEN;
381 cctl |= CCTL_ENDIAN_RSP;
382 mw32_f(MVS_CTL, cctl);
383
384 /* reset CMD queue */
385 tmp = mr32(MVS_PCS);
386 tmp |= PCS_CMD_RST;
387 tmp &= ~PCS_SELF_CLEAR;
388 mw32(MVS_PCS, tmp);
389 /*
390 * the max count is 0x1ff, while our max slot is 0x200,
391 * it will make count 0.
392 */
393 tmp = 0;
394 if (MVS_CHIP_SLOT_SZ > 0x1ff)
395 mw32(MVS_INT_COAL, 0x1ff | COAL_EN);
396 else
397 mw32(MVS_INT_COAL, MVS_CHIP_SLOT_SZ | COAL_EN);
398
399 tmp = 0x10000 | interrupt_coalescing;
400 mw32(MVS_INT_COAL_TMOUT, tmp);
401
402 /* ladies and gentlemen, start your engines */
403 mw32(MVS_TX_CFG, 0);
404 mw32(MVS_TX_CFG, MVS_CHIP_SLOT_SZ | TX_EN);
405 mw32(MVS_RX_CFG, MVS_RX_RING_SZ | RX_EN);
406 /* enable CMD/CMPL_Q/RESP mode */
407 mw32(MVS_PCS, PCS_SATA_RETRY | PCS_FIS_RX_EN |
408 PCS_CMD_EN | PCS_CMD_STOP_ERR);
409
410 /* enable completion queue interrupt */
411 tmp = (CINT_PORT_MASK | CINT_DONE | CINT_MEM | CINT_SRS | CINT_CI_STOP |
412 CINT_DMA_PCIE);
413
414 mw32(MVS_INT_MASK, tmp);
415
416 /* Enable SRS interrupt */
417 mw32(MVS_INT_MASK_SRS_0, 0xFFFF);
418
419 return 0;
420 }
421
mvs_64xx_ioremap(struct mvs_info * mvi)422 static int mvs_64xx_ioremap(struct mvs_info *mvi)
423 {
424 if (!mvs_ioremap(mvi, 4, 2))
425 return 0;
426 return -1;
427 }
428
mvs_64xx_iounmap(struct mvs_info * mvi)429 static void mvs_64xx_iounmap(struct mvs_info *mvi)
430 {
431 mvs_iounmap(mvi->regs);
432 mvs_iounmap(mvi->regs_ex);
433 }
434
mvs_64xx_interrupt_enable(struct mvs_info * mvi)435 static void mvs_64xx_interrupt_enable(struct mvs_info *mvi)
436 {
437 void __iomem *regs = mvi->regs;
438 u32 tmp;
439
440 tmp = mr32(MVS_GBL_CTL);
441 mw32(MVS_GBL_CTL, tmp | INT_EN);
442 }
443
mvs_64xx_interrupt_disable(struct mvs_info * mvi)444 static void mvs_64xx_interrupt_disable(struct mvs_info *mvi)
445 {
446 void __iomem *regs = mvi->regs;
447 u32 tmp;
448
449 tmp = mr32(MVS_GBL_CTL);
450 mw32(MVS_GBL_CTL, tmp & ~INT_EN);
451 }
452
mvs_64xx_isr_status(struct mvs_info * mvi,int irq)453 static u32 mvs_64xx_isr_status(struct mvs_info *mvi, int irq)
454 {
455 void __iomem *regs = mvi->regs;
456 u32 stat;
457
458 if (!(mvi->flags & MVF_FLAG_SOC)) {
459 stat = mr32(MVS_GBL_INT_STAT);
460
461 if (stat == 0 || stat == 0xffffffff)
462 return 0;
463 } else
464 stat = 1;
465 return stat;
466 }
467
mvs_64xx_isr(struct mvs_info * mvi,int irq,u32 stat)468 static irqreturn_t mvs_64xx_isr(struct mvs_info *mvi, int irq, u32 stat)
469 {
470 void __iomem *regs = mvi->regs;
471
472 /* clear CMD_CMPLT ASAP */
473 mw32_f(MVS_INT_STAT, CINT_DONE);
474
475 spin_lock(&mvi->lock);
476 mvs_int_full(mvi);
477 spin_unlock(&mvi->lock);
478
479 return IRQ_HANDLED;
480 }
481
mvs_64xx_command_active(struct mvs_info * mvi,u32 slot_idx)482 static void mvs_64xx_command_active(struct mvs_info *mvi, u32 slot_idx)
483 {
484 u32 tmp;
485 mvs_cw32(mvi, 0x40 + (slot_idx >> 3), 1 << (slot_idx % 32));
486 mvs_cw32(mvi, 0x00 + (slot_idx >> 3), 1 << (slot_idx % 32));
487 do {
488 tmp = mvs_cr32(mvi, 0x00 + (slot_idx >> 3));
489 } while (tmp & 1 << (slot_idx % 32));
490 do {
491 tmp = mvs_cr32(mvi, 0x40 + (slot_idx >> 3));
492 } while (tmp & 1 << (slot_idx % 32));
493 }
494
mvs_64xx_issue_stop(struct mvs_info * mvi,enum mvs_port_type type,u32 tfs)495 static void mvs_64xx_issue_stop(struct mvs_info *mvi, enum mvs_port_type type,
496 u32 tfs)
497 {
498 void __iomem *regs = mvi->regs;
499 u32 tmp;
500
501 if (type == PORT_TYPE_SATA) {
502 tmp = mr32(MVS_INT_STAT_SRS_0) | (1U << tfs);
503 mw32(MVS_INT_STAT_SRS_0, tmp);
504 }
505 mw32(MVS_INT_STAT, CINT_CI_STOP);
506 tmp = mr32(MVS_PCS) | 0xFF00;
507 mw32(MVS_PCS, tmp);
508 }
509
mvs_64xx_free_reg_set(struct mvs_info * mvi,u8 * tfs)510 static void mvs_64xx_free_reg_set(struct mvs_info *mvi, u8 *tfs)
511 {
512 void __iomem *regs = mvi->regs;
513 u32 tmp, offs;
514
515 if (*tfs == MVS_ID_NOT_MAPPED)
516 return;
517
518 offs = 1U << ((*tfs & 0x0f) + PCS_EN_SATA_REG_SHIFT);
519 if (*tfs < 16) {
520 tmp = mr32(MVS_PCS);
521 mw32(MVS_PCS, tmp & ~offs);
522 } else {
523 tmp = mr32(MVS_CTL);
524 mw32(MVS_CTL, tmp & ~offs);
525 }
526
527 tmp = mr32(MVS_INT_STAT_SRS_0) & (1U << *tfs);
528 if (tmp)
529 mw32(MVS_INT_STAT_SRS_0, tmp);
530
531 *tfs = MVS_ID_NOT_MAPPED;
532 return;
533 }
534
mvs_64xx_assign_reg_set(struct mvs_info * mvi,u8 * tfs)535 static u8 mvs_64xx_assign_reg_set(struct mvs_info *mvi, u8 *tfs)
536 {
537 int i;
538 u32 tmp, offs;
539 void __iomem *regs = mvi->regs;
540
541 if (*tfs != MVS_ID_NOT_MAPPED)
542 return 0;
543
544 tmp = mr32(MVS_PCS);
545
546 for (i = 0; i < mvi->chip->srs_sz; i++) {
547 if (i == 16)
548 tmp = mr32(MVS_CTL);
549 offs = 1U << ((i & 0x0f) + PCS_EN_SATA_REG_SHIFT);
550 if (!(tmp & offs)) {
551 *tfs = i;
552
553 if (i < 16)
554 mw32(MVS_PCS, tmp | offs);
555 else
556 mw32(MVS_CTL, tmp | offs);
557 tmp = mr32(MVS_INT_STAT_SRS_0) & (1U << i);
558 if (tmp)
559 mw32(MVS_INT_STAT_SRS_0, tmp);
560 return 0;
561 }
562 }
563 return MVS_ID_NOT_MAPPED;
564 }
565
mvs_64xx_make_prd(struct scatterlist * scatter,int nr,void * prd)566 void mvs_64xx_make_prd(struct scatterlist *scatter, int nr, void *prd)
567 {
568 int i;
569 struct scatterlist *sg;
570 struct mvs_prd *buf_prd = prd;
571 for_each_sg(scatter, sg, nr, i) {
572 buf_prd->addr = cpu_to_le64(sg_dma_address(sg));
573 buf_prd->len = cpu_to_le32(sg_dma_len(sg));
574 buf_prd++;
575 }
576 }
577
mvs_64xx_oob_done(struct mvs_info * mvi,int i)578 static int mvs_64xx_oob_done(struct mvs_info *mvi, int i)
579 {
580 u32 phy_st;
581 mvs_write_port_cfg_addr(mvi, i,
582 PHYR_PHY_STAT);
583 phy_st = mvs_read_port_cfg_data(mvi, i);
584 if (phy_st & PHY_OOB_DTCTD)
585 return 1;
586 return 0;
587 }
588
mvs_64xx_fix_phy_info(struct mvs_info * mvi,int i,struct sas_identify_frame * id)589 static void mvs_64xx_fix_phy_info(struct mvs_info *mvi, int i,
590 struct sas_identify_frame *id)
591
592 {
593 struct mvs_phy *phy = &mvi->phy[i];
594 struct asd_sas_phy *sas_phy = &phy->sas_phy;
595
596 sas_phy->linkrate =
597 (phy->phy_status & PHY_NEG_SPP_PHYS_LINK_RATE_MASK) >>
598 PHY_NEG_SPP_PHYS_LINK_RATE_MASK_OFFSET;
599
600 phy->minimum_linkrate =
601 (phy->phy_status &
602 PHY_MIN_SPP_PHYS_LINK_RATE_MASK) >> 8;
603 phy->maximum_linkrate =
604 (phy->phy_status &
605 PHY_MAX_SPP_PHYS_LINK_RATE_MASK) >> 12;
606
607 mvs_write_port_cfg_addr(mvi, i, PHYR_IDENTIFY);
608 phy->dev_info = mvs_read_port_cfg_data(mvi, i);
609
610 mvs_write_port_cfg_addr(mvi, i, PHYR_ATT_DEV_INFO);
611 phy->att_dev_info = mvs_read_port_cfg_data(mvi, i);
612
613 mvs_write_port_cfg_addr(mvi, i, PHYR_ATT_ADDR_HI);
614 phy->att_dev_sas_addr =
615 (u64) mvs_read_port_cfg_data(mvi, i) << 32;
616 mvs_write_port_cfg_addr(mvi, i, PHYR_ATT_ADDR_LO);
617 phy->att_dev_sas_addr |= mvs_read_port_cfg_data(mvi, i);
618 phy->att_dev_sas_addr = SAS_ADDR(&phy->att_dev_sas_addr);
619 }
620
mvs_64xx_phy_work_around(struct mvs_info * mvi,int i)621 static void mvs_64xx_phy_work_around(struct mvs_info *mvi, int i)
622 {
623 u32 tmp;
624 struct mvs_phy *phy = &mvi->phy[i];
625 mvs_write_port_vsr_addr(mvi, i, VSR_PHY_MODE6);
626 tmp = mvs_read_port_vsr_data(mvi, i);
627 if (((phy->phy_status & PHY_NEG_SPP_PHYS_LINK_RATE_MASK) >>
628 PHY_NEG_SPP_PHYS_LINK_RATE_MASK_OFFSET) ==
629 SAS_LINK_RATE_1_5_GBPS)
630 tmp &= ~PHY_MODE6_LATECLK;
631 else
632 tmp |= PHY_MODE6_LATECLK;
633 mvs_write_port_vsr_data(mvi, i, tmp);
634 }
635
mvs_64xx_phy_set_link_rate(struct mvs_info * mvi,u32 phy_id,struct sas_phy_linkrates * rates)636 void mvs_64xx_phy_set_link_rate(struct mvs_info *mvi, u32 phy_id,
637 struct sas_phy_linkrates *rates)
638 {
639 u32 lrmin = 0, lrmax = 0;
640 u32 tmp;
641
642 tmp = mvs_read_phy_ctl(mvi, phy_id);
643 lrmin = (rates->minimum_linkrate << 8);
644 lrmax = (rates->maximum_linkrate << 12);
645
646 if (lrmin) {
647 tmp &= ~(0xf << 8);
648 tmp |= lrmin;
649 }
650 if (lrmax) {
651 tmp &= ~(0xf << 12);
652 tmp |= lrmax;
653 }
654 mvs_write_phy_ctl(mvi, phy_id, tmp);
655 mvs_64xx_phy_reset(mvi, phy_id, MVS_HARD_RESET);
656 }
657
mvs_64xx_clear_active_cmds(struct mvs_info * mvi)658 static void mvs_64xx_clear_active_cmds(struct mvs_info *mvi)
659 {
660 u32 tmp;
661 void __iomem *regs = mvi->regs;
662 tmp = mr32(MVS_PCS);
663 mw32(MVS_PCS, tmp & 0xFFFF);
664 mw32(MVS_PCS, tmp);
665 tmp = mr32(MVS_CTL);
666 mw32(MVS_CTL, tmp & 0xFFFF);
667 mw32(MVS_CTL, tmp);
668 }
669
670
mvs_64xx_spi_read_data(struct mvs_info * mvi)671 u32 mvs_64xx_spi_read_data(struct mvs_info *mvi)
672 {
673 void __iomem *regs = mvi->regs_ex;
674 return ior32(SPI_DATA_REG_64XX);
675 }
676
mvs_64xx_spi_write_data(struct mvs_info * mvi,u32 data)677 void mvs_64xx_spi_write_data(struct mvs_info *mvi, u32 data)
678 {
679 void __iomem *regs = mvi->regs_ex;
680 iow32(SPI_DATA_REG_64XX, data);
681 }
682
683
mvs_64xx_spi_buildcmd(struct mvs_info * mvi,u32 * dwCmd,u8 cmd,u8 read,u8 length,u32 addr)684 int mvs_64xx_spi_buildcmd(struct mvs_info *mvi,
685 u32 *dwCmd,
686 u8 cmd,
687 u8 read,
688 u8 length,
689 u32 addr
690 )
691 {
692 u32 dwTmp;
693
694 dwTmp = ((u32)cmd << 24) | ((u32)length << 19);
695 if (read)
696 dwTmp |= 1U<<23;
697
698 if (addr != MV_MAX_U32) {
699 dwTmp |= 1U<<22;
700 dwTmp |= (addr & 0x0003FFFF);
701 }
702
703 *dwCmd = dwTmp;
704 return 0;
705 }
706
707
mvs_64xx_spi_issuecmd(struct mvs_info * mvi,u32 cmd)708 int mvs_64xx_spi_issuecmd(struct mvs_info *mvi, u32 cmd)
709 {
710 void __iomem *regs = mvi->regs_ex;
711 int retry;
712
713 for (retry = 0; retry < 1; retry++) {
714 iow32(SPI_CTRL_REG_64XX, SPI_CTRL_VENDOR_ENABLE);
715 iow32(SPI_CMD_REG_64XX, cmd);
716 iow32(SPI_CTRL_REG_64XX,
717 SPI_CTRL_VENDOR_ENABLE | SPI_CTRL_SPISTART);
718 }
719
720 return 0;
721 }
722
mvs_64xx_spi_waitdataready(struct mvs_info * mvi,u32 timeout)723 int mvs_64xx_spi_waitdataready(struct mvs_info *mvi, u32 timeout)
724 {
725 void __iomem *regs = mvi->regs_ex;
726 u32 i, dwTmp;
727
728 for (i = 0; i < timeout; i++) {
729 dwTmp = ior32(SPI_CTRL_REG_64XX);
730 if (!(dwTmp & SPI_CTRL_SPISTART))
731 return 0;
732 msleep(10);
733 }
734
735 return -1;
736 }
737
mvs_64xx_fix_dma(struct mvs_info * mvi,u32 phy_mask,int buf_len,int from,void * prd)738 void mvs_64xx_fix_dma(struct mvs_info *mvi, u32 phy_mask,
739 int buf_len, int from, void *prd)
740 {
741 int i;
742 struct mvs_prd *buf_prd = prd;
743 dma_addr_t buf_dma = mvi->bulk_buffer_dma;
744
745 buf_prd += from;
746 for (i = 0; i < MAX_SG_ENTRY - from; i++) {
747 buf_prd->addr = cpu_to_le64(buf_dma);
748 buf_prd->len = cpu_to_le32(buf_len);
749 ++buf_prd;
750 }
751 }
752
mvs_64xx_tune_interrupt(struct mvs_info * mvi,u32 time)753 static void mvs_64xx_tune_interrupt(struct mvs_info *mvi, u32 time)
754 {
755 void __iomem *regs = mvi->regs;
756 u32 tmp = 0;
757 /*
758 * the max count is 0x1ff, while our max slot is 0x200,
759 * it will make count 0.
760 */
761 if (time == 0) {
762 mw32(MVS_INT_COAL, 0);
763 mw32(MVS_INT_COAL_TMOUT, 0x10000);
764 } else {
765 if (MVS_CHIP_SLOT_SZ > 0x1ff)
766 mw32(MVS_INT_COAL, 0x1ff|COAL_EN);
767 else
768 mw32(MVS_INT_COAL, MVS_CHIP_SLOT_SZ|COAL_EN);
769
770 tmp = 0x10000 | time;
771 mw32(MVS_INT_COAL_TMOUT, tmp);
772 }
773 }
774
775 const struct mvs_dispatch mvs_64xx_dispatch = {
776 "mv64xx",
777 mvs_64xx_init,
778 NULL,
779 mvs_64xx_ioremap,
780 mvs_64xx_iounmap,
781 mvs_64xx_isr,
782 mvs_64xx_isr_status,
783 mvs_64xx_interrupt_enable,
784 mvs_64xx_interrupt_disable,
785 mvs_read_phy_ctl,
786 mvs_write_phy_ctl,
787 mvs_read_port_cfg_data,
788 mvs_write_port_cfg_data,
789 mvs_write_port_cfg_addr,
790 mvs_read_port_vsr_data,
791 mvs_write_port_vsr_data,
792 mvs_write_port_vsr_addr,
793 mvs_read_port_irq_stat,
794 mvs_write_port_irq_stat,
795 mvs_read_port_irq_mask,
796 mvs_write_port_irq_mask,
797 mvs_64xx_command_active,
798 mvs_64xx_clear_srs_irq,
799 mvs_64xx_issue_stop,
800 mvs_start_delivery,
801 mvs_rx_update,
802 mvs_int_full,
803 mvs_64xx_assign_reg_set,
804 mvs_64xx_free_reg_set,
805 mvs_get_prd_size,
806 mvs_get_prd_count,
807 mvs_64xx_make_prd,
808 mvs_64xx_detect_porttype,
809 mvs_64xx_oob_done,
810 mvs_64xx_fix_phy_info,
811 mvs_64xx_phy_work_around,
812 mvs_64xx_phy_set_link_rate,
813 mvs_hw_max_link_rate,
814 mvs_64xx_phy_disable,
815 mvs_64xx_phy_enable,
816 mvs_64xx_phy_reset,
817 mvs_64xx_stp_reset,
818 mvs_64xx_clear_active_cmds,
819 mvs_64xx_spi_read_data,
820 mvs_64xx_spi_write_data,
821 mvs_64xx_spi_buildcmd,
822 mvs_64xx_spi_issuecmd,
823 mvs_64xx_spi_waitdataready,
824 mvs_64xx_fix_dma,
825 mvs_64xx_tune_interrupt,
826 NULL,
827 };
828
829