| /* | 
 |  * CAAM/SEC 4.x functions for using scatterlists in caam driver | 
 |  * | 
 |  * Copyright 2008-2011 Freescale Semiconductor, Inc. | 
 |  * | 
 |  */ | 
 |  | 
 | #include "regs.h" | 
 |  | 
 | struct sec4_sg_entry { | 
 | 	u64 ptr; | 
 | 	u32 len; | 
 | 	u32 bpid_offset; | 
 | }; | 
 |  | 
 | /* | 
 |  * convert single dma address to h/w link table format | 
 |  */ | 
 | static inline void dma_to_sec4_sg_one(struct sec4_sg_entry *sec4_sg_ptr, | 
 | 				      dma_addr_t dma, u32 len, u16 offset) | 
 | { | 
 | 	sec4_sg_ptr->ptr = cpu_to_caam_dma64(dma); | 
 | 	sec4_sg_ptr->len = cpu_to_caam32(len); | 
 | 	sec4_sg_ptr->bpid_offset = cpu_to_caam32(offset & SEC4_SG_OFFSET_MASK); | 
 | #ifdef DEBUG | 
 | 	print_hex_dump(KERN_ERR, "sec4_sg_ptr@: ", | 
 | 		       DUMP_PREFIX_ADDRESS, 16, 4, sec4_sg_ptr, | 
 | 		       sizeof(struct sec4_sg_entry), 1); | 
 | #endif | 
 | } | 
 |  | 
 | /* | 
 |  * convert scatterlist to h/w link table format | 
 |  * but does not have final bit; instead, returns last entry | 
 |  */ | 
 | static inline struct sec4_sg_entry * | 
 | sg_to_sec4_sg(struct scatterlist *sg, int sg_count, | 
 | 	      struct sec4_sg_entry *sec4_sg_ptr, u16 offset) | 
 | { | 
 | 	while (sg_count) { | 
 | 		dma_to_sec4_sg_one(sec4_sg_ptr, sg_dma_address(sg), | 
 | 				   sg_dma_len(sg), offset); | 
 | 		sec4_sg_ptr++; | 
 | 		sg = sg_next(sg); | 
 | 		sg_count--; | 
 | 	} | 
 | 	return sec4_sg_ptr - 1; | 
 | } | 
 |  | 
 | /* | 
 |  * convert scatterlist to h/w link table format | 
 |  * scatterlist must have been previously dma mapped | 
 |  */ | 
 | static inline void sg_to_sec4_sg_last(struct scatterlist *sg, int sg_count, | 
 | 				      struct sec4_sg_entry *sec4_sg_ptr, | 
 | 				      u16 offset) | 
 | { | 
 | 	sec4_sg_ptr = sg_to_sec4_sg(sg, sg_count, sec4_sg_ptr, offset); | 
 | 	sec4_sg_ptr->len |= cpu_to_caam32(SEC4_SG_LEN_FIN); | 
 | } | 
 |  | 
 | static inline struct sec4_sg_entry *sg_to_sec4_sg_len( | 
 | 	struct scatterlist *sg, unsigned int total, | 
 | 	struct sec4_sg_entry *sec4_sg_ptr) | 
 | { | 
 | 	do { | 
 | 		unsigned int len = min(sg_dma_len(sg), total); | 
 |  | 
 | 		dma_to_sec4_sg_one(sec4_sg_ptr, sg_dma_address(sg), len, 0); | 
 | 		sec4_sg_ptr++; | 
 | 		sg = sg_next(sg); | 
 | 		total -= len; | 
 | 	} while (total); | 
 | 	return sec4_sg_ptr - 1; | 
 | } |