Back to home page

OSCL-LXR

 
 

    


0001 /* SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause) */
0002 /*
0003  * Copyright 2013-2016 Freescale Semiconductor, Inc.
0004  * Copyright 2016-2017 NXP
0005  */
0006 
0007 #ifndef __SG_SW_QM_H
0008 #define __SG_SW_QM_H
0009 
0010 #include <soc/fsl/qman.h>
0011 #include "regs.h"
0012 
0013 static inline void __dma_to_qm_sg(struct qm_sg_entry *qm_sg_ptr, dma_addr_t dma,
0014                   u16 offset)
0015 {
0016     qm_sg_entry_set64(qm_sg_ptr, dma);
0017     qm_sg_ptr->__reserved2 = 0;
0018     qm_sg_ptr->bpid = 0;
0019     qm_sg_ptr->offset = cpu_to_be16(offset & QM_SG_OFF_MASK);
0020 }
0021 
0022 static inline void dma_to_qm_sg_one(struct qm_sg_entry *qm_sg_ptr,
0023                     dma_addr_t dma, u32 len, u16 offset)
0024 {
0025     __dma_to_qm_sg(qm_sg_ptr, dma, offset);
0026     qm_sg_entry_set_len(qm_sg_ptr, len);
0027 }
0028 
0029 static inline void dma_to_qm_sg_one_last(struct qm_sg_entry *qm_sg_ptr,
0030                      dma_addr_t dma, u32 len, u16 offset)
0031 {
0032     __dma_to_qm_sg(qm_sg_ptr, dma, offset);
0033     qm_sg_entry_set_f(qm_sg_ptr, len);
0034 }
0035 
0036 static inline void dma_to_qm_sg_one_ext(struct qm_sg_entry *qm_sg_ptr,
0037                     dma_addr_t dma, u32 len, u16 offset)
0038 {
0039     __dma_to_qm_sg(qm_sg_ptr, dma, offset);
0040     qm_sg_ptr->cfg = cpu_to_be32(QM_SG_EXT | (len & QM_SG_LEN_MASK));
0041 }
0042 
0043 static inline void dma_to_qm_sg_one_last_ext(struct qm_sg_entry *qm_sg_ptr,
0044                          dma_addr_t dma, u32 len,
0045                          u16 offset)
0046 {
0047     __dma_to_qm_sg(qm_sg_ptr, dma, offset);
0048     qm_sg_ptr->cfg = cpu_to_be32(QM_SG_EXT | QM_SG_FIN |
0049                      (len & QM_SG_LEN_MASK));
0050 }
0051 
0052 /*
0053  * convert scatterlist to h/w link table format
0054  * but does not have final bit; instead, returns last entry
0055  */
0056 static inline struct qm_sg_entry *
0057 sg_to_qm_sg(struct scatterlist *sg, int len,
0058         struct qm_sg_entry *qm_sg_ptr, u16 offset)
0059 {
0060     int ent_len;
0061 
0062     while (len) {
0063         ent_len = min_t(int, sg_dma_len(sg), len);
0064 
0065         dma_to_qm_sg_one(qm_sg_ptr, sg_dma_address(sg), ent_len,
0066                  offset);
0067         qm_sg_ptr++;
0068         sg = sg_next(sg);
0069         len -= ent_len;
0070     }
0071     return qm_sg_ptr - 1;
0072 }
0073 
0074 /*
0075  * convert scatterlist to h/w link table format
0076  * scatterlist must have been previously dma mapped
0077  */
0078 static inline void sg_to_qm_sg_last(struct scatterlist *sg, int len,
0079                     struct qm_sg_entry *qm_sg_ptr, u16 offset)
0080 {
0081     qm_sg_ptr = sg_to_qm_sg(sg, len, qm_sg_ptr, offset);
0082     qm_sg_entry_set_f(qm_sg_ptr, qm_sg_entry_get_len(qm_sg_ptr));
0083 }
0084 
0085 #endif /* __SG_SW_QM_H */