From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S966445AbcLVQjL (ORCPT ); Thu, 22 Dec 2016 11:39:11 -0500 Received: from exsmtp02.microchip.com ([198.175.253.38]:49459 "EHLO email.microchip.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S966343AbcLVQiJ (ORCPT ); Thu, 22 Dec 2016 11:38:09 -0500 From: Cyrille Pitchen To: , , CC: , , , Cyrille Pitchen Subject: [PATCH v2 08/12] crypto: atmel-sha: add simple DMA transfers Date: Thu, 22 Dec 2016 17:37:57 +0100 Message-ID: <4c438dc06f85e151dea4a42078d5e1d32d4829c1.1482424395.git.cyrille.pitchen@atmel.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: References: MIME-Version: 1.0 Content-Type: text/plain X-Brightmail-Tracker: H4sIAAAAAAAAC+NgFupiVWLjYuHi8mHRLWCMiTBo3DNrC6PF4YVTGC0evO9ksZg2/R2zxb1P2xgtOqasYnJgDWCIYs3MS8qvSGDNWH1pC2PBF5mKZYunsDQwdol3MXJxCAmsY5R4++YEUxcjJwebgKHE2wdHWUFsEYFAiYUtrxhBipgFpjNKPFj9jh0kISzgKvHk4F02EJtFQFXi8L2ZYM28AvESB9u3MoPYEgJyEjfPdYLZnAK2Euvn3gMaygG0zUbi4FshiHJBiZMzn7CA2MwCEhIHX7wAKxcSUAPauwJqTKDE1ktXmSBsJ4lZPzezQNh2EoenX2SHsO0lLu27xAJTc+njC6h6bYntr/axQtg6EtsO9kPV2ErsmTERqsZd4sGj5VC2r8Sshw1QNVESt5t3sU9glJiF5NRZSE5dwMi0ilHa2cNPNzhM1zXC2cPASC83OaNANzcxM08vOT93EyMkntR2MM7s8T/EKMnBpCTKu3XS+XAhvqT8lMqMxOKM+KLSnNTiQ4wSHDxKIrwblwPleIsLEnOLM9NhUjIcHEoSvBEgKcGi1PTUirTMnJLUIoj0KUZJKXHeaJCkAEhfRmkeXO4So6iUMG/UUqAcT0FqUW5mCUT8FqMwx0MmIZa8/LxUKaATGYBAg/EVozgHo5Iw736QWTyZeSVwJ7wCuo4J6Lp1u0+DXFeSiJCSamCs5YxznM2TcXBi4Xne76nJjBeZlNLDfgSrPawOTC17U+/Ido9RqGhC2IZ1E/dmtX90+ufy3erWgdfm2hn3nGOsracb7nIWqeh0yPj2PVg+30Bz1v1XSXkhz73LHNLuFKR776lnWC7IwWuvH9Uu8nCfuYHX173ZG5I/ZZ3zfLTigoztkynJu5RYijMSDbWYi4oTAayTNfQdAwAA Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org This patch adds a simple function to perform data transfer with the DMA controller. Signed-off-by: Cyrille Pitchen --- drivers/crypto/atmel-sha.c | 116 +++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 116 insertions(+) diff --git a/drivers/crypto/atmel-sha.c b/drivers/crypto/atmel-sha.c index 58d9ca8ac0f2..a4fc60b67099 100644 --- a/drivers/crypto/atmel-sha.c +++ b/drivers/crypto/atmel-sha.c @@ -123,6 +123,9 @@ struct atmel_sha_ctx { struct atmel_sha_dma { struct dma_chan *chan; struct dma_slave_config dma_conf; + struct scatterlist *sg; + int nents; + unsigned int last_sg_length; }; struct atmel_sha_dev { @@ -1321,6 +1324,119 @@ static irqreturn_t atmel_sha_irq(int irq, void *dev_id) } +/* DMA transfer functions */ + +static bool atmel_sha_dma_check_aligned(struct atmel_sha_dev *dd, + struct scatterlist *sg, + size_t len) +{ + struct atmel_sha_dma *dma = &dd->dma_lch_in; + struct ahash_request *req = dd->req; + struct atmel_sha_reqctx *ctx = ahash_request_ctx(req); + size_t bs = ctx->block_size; + int nents; + + for (nents = 0; sg; sg = sg_next(sg), ++nents) { + if (!IS_ALIGNED(sg->offset, sizeof(u32))) + return false; + + /* + * This is the last sg, the only one that is allowed to + * have an unaligned length. + */ + if (len <= sg->length) { + dma->nents = nents + 1; + dma->last_sg_length = sg->length; + sg->length = ALIGN(len, sizeof(u32)); + return true; + } + + /* All other sg lengths MUST be aligned to the block size. */ + if (!IS_ALIGNED(sg->length, bs)) + return false; + + len -= sg->length; + } + + return false; +} + +static void atmel_sha_dma_callback2(void *data) +{ + struct atmel_sha_dev *dd = data; + struct atmel_sha_dma *dma = &dd->dma_lch_in; + struct scatterlist *sg; + int nents; + + dmaengine_terminate_all(dma->chan); + dma_unmap_sg(dd->dev, dma->sg, dma->nents, DMA_TO_DEVICE); + + sg = dma->sg; + for (nents = 0; nents < dma->nents - 1; ++nents) + sg = sg_next(sg); + sg->length = dma->last_sg_length; + + dd->is_async = true; + (void)atmel_sha_wait_for_data_ready(dd, dd->resume); +} + +static int atmel_sha_dma_start(struct atmel_sha_dev *dd, + struct scatterlist *src, + size_t len, + atmel_sha_fn_t resume) +{ + struct atmel_sha_dma *dma = &dd->dma_lch_in; + struct dma_slave_config *config = &dma->dma_conf; + struct dma_chan *chan = dma->chan; + struct dma_async_tx_descriptor *desc; + dma_cookie_t cookie; + unsigned int sg_len; + int err; + + dd->resume = resume; + + /* + * dma->nents has already been initialized by + * atmel_sha_dma_check_aligned(). + */ + dma->sg = src; + sg_len = dma_map_sg(dd->dev, dma->sg, dma->nents, DMA_TO_DEVICE); + if (!sg_len) { + err = -ENOMEM; + goto exit; + } + + config->src_maxburst = 16; + config->dst_maxburst = 16; + err = dmaengine_slave_config(chan, config); + if (err) + goto unmap_sg; + + desc = dmaengine_prep_slave_sg(chan, dma->sg, sg_len, DMA_MEM_TO_DEV, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!desc) { + err = -ENOMEM; + goto unmap_sg; + } + + desc->callback = atmel_sha_dma_callback2; + desc->callback_param = dd; + cookie = dmaengine_submit(desc); + err = dma_submit_error(cookie); + if (err) + goto unmap_sg; + + dma_async_issue_pending(chan); + + return -EINPROGRESS; + +unmap_sg: + dma_unmap_sg(dd->dev, dma->sg, dma->nents, DMA_TO_DEVICE); +exit: + return atmel_sha_complete(dd, err); +} + + /* CPU transfer functions */ static int atmel_sha_cpu_transfer(struct atmel_sha_dev *dd) -- 2.7.4