1*3bb16560SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
29a322993SPhilippe De Muyter /*
39a322993SPhilippe De Muyter * Bestcomm ATA task driver
49a322993SPhilippe De Muyter *
59a322993SPhilippe De Muyter * Patterned after bestcomm/fec.c by Dale Farnsworth <dfarnsworth@mvista.com>
69a322993SPhilippe De Muyter * 2003-2004 (c) MontaVista, Software, Inc.
79a322993SPhilippe De Muyter *
89a322993SPhilippe De Muyter * Copyright (C) 2006-2007 Sylvain Munaut <tnt@246tNt.com>
99a322993SPhilippe De Muyter * Copyright (C) 2006 Freescale - John Rigby
109a322993SPhilippe De Muyter */
119a322993SPhilippe De Muyter
129a322993SPhilippe De Muyter #include <linux/kernel.h>
139a322993SPhilippe De Muyter #include <linux/module.h>
149a322993SPhilippe De Muyter #include <linux/types.h>
159a322993SPhilippe De Muyter #include <asm/io.h>
169a322993SPhilippe De Muyter
179a322993SPhilippe De Muyter #include <linux/fsl/bestcomm/bestcomm.h>
189a322993SPhilippe De Muyter #include <linux/fsl/bestcomm/bestcomm_priv.h>
199a322993SPhilippe De Muyter #include <linux/fsl/bestcomm/ata.h>
209a322993SPhilippe De Muyter
219a322993SPhilippe De Muyter
229a322993SPhilippe De Muyter /* ======================================================================== */
239a322993SPhilippe De Muyter /* Task image/var/inc */
249a322993SPhilippe De Muyter /* ======================================================================== */
259a322993SPhilippe De Muyter
269a322993SPhilippe De Muyter /* ata task image */
279a322993SPhilippe De Muyter extern u32 bcom_ata_task[];
289a322993SPhilippe De Muyter
299a322993SPhilippe De Muyter /* ata task vars that need to be set before enabling the task */
309a322993SPhilippe De Muyter struct bcom_ata_var {
319a322993SPhilippe De Muyter u32 enable; /* (u16*) address of task's control register */
329a322993SPhilippe De Muyter u32 bd_base; /* (struct bcom_bd*) beginning of ring buffer */
339a322993SPhilippe De Muyter u32 bd_last; /* (struct bcom_bd*) end of ring buffer */
349a322993SPhilippe De Muyter u32 bd_start; /* (struct bcom_bd*) current bd */
359a322993SPhilippe De Muyter u32 buffer_size; /* size of receive buffer */
369a322993SPhilippe De Muyter };
379a322993SPhilippe De Muyter
389a322993SPhilippe De Muyter /* ata task incs that need to be set before enabling the task */
399a322993SPhilippe De Muyter struct bcom_ata_inc {
409a322993SPhilippe De Muyter u16 pad0;
419a322993SPhilippe De Muyter s16 incr_bytes;
429a322993SPhilippe De Muyter u16 pad1;
439a322993SPhilippe De Muyter s16 incr_dst;
449a322993SPhilippe De Muyter u16 pad2;
459a322993SPhilippe De Muyter s16 incr_src;
469a322993SPhilippe De Muyter };
479a322993SPhilippe De Muyter
489a322993SPhilippe De Muyter
499a322993SPhilippe De Muyter /* ======================================================================== */
509a322993SPhilippe De Muyter /* Task support code */
519a322993SPhilippe De Muyter /* ======================================================================== */
529a322993SPhilippe De Muyter
539a322993SPhilippe De Muyter struct bcom_task *
bcom_ata_init(int queue_len,int maxbufsize)549a322993SPhilippe De Muyter bcom_ata_init(int queue_len, int maxbufsize)
559a322993SPhilippe De Muyter {
569a322993SPhilippe De Muyter struct bcom_task *tsk;
579a322993SPhilippe De Muyter struct bcom_ata_var *var;
589a322993SPhilippe De Muyter struct bcom_ata_inc *inc;
599a322993SPhilippe De Muyter
609a322993SPhilippe De Muyter /* Prefetch breaks ATA DMA. Turn it off for ATA DMA */
619a322993SPhilippe De Muyter bcom_disable_prefetch();
629a322993SPhilippe De Muyter
639a322993SPhilippe De Muyter tsk = bcom_task_alloc(queue_len, sizeof(struct bcom_ata_bd), 0);
649a322993SPhilippe De Muyter if (!tsk)
659a322993SPhilippe De Muyter return NULL;
669a322993SPhilippe De Muyter
679a322993SPhilippe De Muyter tsk->flags = BCOM_FLAGS_NONE;
689a322993SPhilippe De Muyter
699a322993SPhilippe De Muyter bcom_ata_reset_bd(tsk);
709a322993SPhilippe De Muyter
719a322993SPhilippe De Muyter var = (struct bcom_ata_var *) bcom_task_var(tsk->tasknum);
729a322993SPhilippe De Muyter inc = (struct bcom_ata_inc *) bcom_task_inc(tsk->tasknum);
739a322993SPhilippe De Muyter
749a322993SPhilippe De Muyter if (bcom_load_image(tsk->tasknum, bcom_ata_task)) {
759a322993SPhilippe De Muyter bcom_task_free(tsk);
769a322993SPhilippe De Muyter return NULL;
779a322993SPhilippe De Muyter }
789a322993SPhilippe De Muyter
799a322993SPhilippe De Muyter var->enable = bcom_eng->regs_base +
809a322993SPhilippe De Muyter offsetof(struct mpc52xx_sdma, tcr[tsk->tasknum]);
819a322993SPhilippe De Muyter var->bd_base = tsk->bd_pa;
829a322993SPhilippe De Muyter var->bd_last = tsk->bd_pa + ((tsk->num_bd-1) * tsk->bd_size);
839a322993SPhilippe De Muyter var->bd_start = tsk->bd_pa;
849a322993SPhilippe De Muyter var->buffer_size = maxbufsize;
859a322993SPhilippe De Muyter
869a322993SPhilippe De Muyter /* Configure some stuff */
879a322993SPhilippe De Muyter bcom_set_task_pragma(tsk->tasknum, BCOM_ATA_PRAGMA);
889a322993SPhilippe De Muyter bcom_set_task_auto_start(tsk->tasknum, tsk->tasknum);
899a322993SPhilippe De Muyter
909a322993SPhilippe De Muyter out_8(&bcom_eng->regs->ipr[BCOM_INITIATOR_ATA_RX], BCOM_IPR_ATA_RX);
919a322993SPhilippe De Muyter out_8(&bcom_eng->regs->ipr[BCOM_INITIATOR_ATA_TX], BCOM_IPR_ATA_TX);
929a322993SPhilippe De Muyter
939a322993SPhilippe De Muyter out_be32(&bcom_eng->regs->IntPend, 1<<tsk->tasknum); /* Clear ints */
949a322993SPhilippe De Muyter
959a322993SPhilippe De Muyter return tsk;
969a322993SPhilippe De Muyter }
979a322993SPhilippe De Muyter EXPORT_SYMBOL_GPL(bcom_ata_init);
989a322993SPhilippe De Muyter
bcom_ata_rx_prepare(struct bcom_task * tsk)999a322993SPhilippe De Muyter void bcom_ata_rx_prepare(struct bcom_task *tsk)
1009a322993SPhilippe De Muyter {
1019a322993SPhilippe De Muyter struct bcom_ata_inc *inc;
1029a322993SPhilippe De Muyter
1039a322993SPhilippe De Muyter inc = (struct bcom_ata_inc *) bcom_task_inc(tsk->tasknum);
1049a322993SPhilippe De Muyter
1059a322993SPhilippe De Muyter inc->incr_bytes = -(s16)sizeof(u32);
1069a322993SPhilippe De Muyter inc->incr_src = 0;
1079a322993SPhilippe De Muyter inc->incr_dst = sizeof(u32);
1089a322993SPhilippe De Muyter
1099a322993SPhilippe De Muyter bcom_set_initiator(tsk->tasknum, BCOM_INITIATOR_ATA_RX);
1109a322993SPhilippe De Muyter }
1119a322993SPhilippe De Muyter EXPORT_SYMBOL_GPL(bcom_ata_rx_prepare);
1129a322993SPhilippe De Muyter
bcom_ata_tx_prepare(struct bcom_task * tsk)1139a322993SPhilippe De Muyter void bcom_ata_tx_prepare(struct bcom_task *tsk)
1149a322993SPhilippe De Muyter {
1159a322993SPhilippe De Muyter struct bcom_ata_inc *inc;
1169a322993SPhilippe De Muyter
1179a322993SPhilippe De Muyter inc = (struct bcom_ata_inc *) bcom_task_inc(tsk->tasknum);
1189a322993SPhilippe De Muyter
1199a322993SPhilippe De Muyter inc->incr_bytes = -(s16)sizeof(u32);
1209a322993SPhilippe De Muyter inc->incr_src = sizeof(u32);
1219a322993SPhilippe De Muyter inc->incr_dst = 0;
1229a322993SPhilippe De Muyter
1239a322993SPhilippe De Muyter bcom_set_initiator(tsk->tasknum, BCOM_INITIATOR_ATA_TX);
1249a322993SPhilippe De Muyter }
1259a322993SPhilippe De Muyter EXPORT_SYMBOL_GPL(bcom_ata_tx_prepare);
1269a322993SPhilippe De Muyter
bcom_ata_reset_bd(struct bcom_task * tsk)1279a322993SPhilippe De Muyter void bcom_ata_reset_bd(struct bcom_task *tsk)
1289a322993SPhilippe De Muyter {
1299a322993SPhilippe De Muyter struct bcom_ata_var *var;
1309a322993SPhilippe De Muyter
1319a322993SPhilippe De Muyter /* Reset all BD */
132adec566bSAnatolij Gustschin memset_io(tsk->bd, 0x00, tsk->num_bd * tsk->bd_size);
1339a322993SPhilippe De Muyter
1349a322993SPhilippe De Muyter tsk->index = 0;
1359a322993SPhilippe De Muyter tsk->outdex = 0;
1369a322993SPhilippe De Muyter
1379a322993SPhilippe De Muyter var = (struct bcom_ata_var *) bcom_task_var(tsk->tasknum);
1389a322993SPhilippe De Muyter var->bd_start = var->bd_base;
1399a322993SPhilippe De Muyter }
1409a322993SPhilippe De Muyter EXPORT_SYMBOL_GPL(bcom_ata_reset_bd);
1419a322993SPhilippe De Muyter
bcom_ata_release(struct bcom_task * tsk)1429a322993SPhilippe De Muyter void bcom_ata_release(struct bcom_task *tsk)
1439a322993SPhilippe De Muyter {
1449a322993SPhilippe De Muyter /* Nothing special for the ATA tasks */
1459a322993SPhilippe De Muyter bcom_task_free(tsk);
1469a322993SPhilippe De Muyter }
1479a322993SPhilippe De Muyter EXPORT_SYMBOL_GPL(bcom_ata_release);
1489a322993SPhilippe De Muyter
1499a322993SPhilippe De Muyter
1509a322993SPhilippe De Muyter MODULE_DESCRIPTION("BestComm ATA task driver");
1519a322993SPhilippe De Muyter MODULE_AUTHOR("John Rigby");
1529a322993SPhilippe De Muyter MODULE_LICENSE("GPL v2");
153