|
@@ -531,3 +531,110 @@ iop3xx_desc_init_xor(struct iop3xx_desc_aau *hw_desc, int src_cnt,
|
|
|
u32 value;
|
|
|
struct iop3xx_aau_desc_ctrl field;
|
|
|
} u_desc_ctrl;
|
|
|
+
|
|
|
+ u_desc_ctrl.value = 0;
|
|
|
+ switch (src_cnt) {
|
|
|
+ case 25 ... 32:
|
|
|
+ u_desc_ctrl.field.blk_ctrl = 0x3; /* use EDCR[2:0] */
|
|
|
+ edcr = 0;
|
|
|
+ shift = 1;
|
|
|
+ for (i = 24; i < src_cnt; i++) {
|
|
|
+ edcr |= (1 << shift);
|
|
|
+ shift += 3;
|
|
|
+ }
|
|
|
+ hw_desc->src_edc[AAU_EDCR2_IDX].e_desc_ctrl = edcr;
|
|
|
+ src_cnt = 24;
|
|
|
+ /* fall through */
|
|
|
+ case 17 ... 24:
|
|
|
+ if (!u_desc_ctrl.field.blk_ctrl) {
|
|
|
+ hw_desc->src_edc[AAU_EDCR2_IDX].e_desc_ctrl = 0;
|
|
|
+ u_desc_ctrl.field.blk_ctrl = 0x3; /* use EDCR[2:0] */
|
|
|
+ }
|
|
|
+ edcr = 0;
|
|
|
+ shift = 1;
|
|
|
+ for (i = 16; i < src_cnt; i++) {
|
|
|
+ edcr |= (1 << shift);
|
|
|
+ shift += 3;
|
|
|
+ }
|
|
|
+ hw_desc->src_edc[AAU_EDCR1_IDX].e_desc_ctrl = edcr;
|
|
|
+ src_cnt = 16;
|
|
|
+ /* fall through */
|
|
|
+ case 9 ... 16:
|
|
|
+ if (!u_desc_ctrl.field.blk_ctrl)
|
|
|
+ u_desc_ctrl.field.blk_ctrl = 0x2; /* use EDCR0 */
|
|
|
+ edcr = 0;
|
|
|
+ shift = 1;
|
|
|
+ for (i = 8; i < src_cnt; i++) {
|
|
|
+ edcr |= (1 << shift);
|
|
|
+ shift += 3;
|
|
|
+ }
|
|
|
+ hw_desc->src_edc[AAU_EDCR0_IDX].e_desc_ctrl = edcr;
|
|
|
+ src_cnt = 8;
|
|
|
+ /* fall through */
|
|
|
+ case 2 ... 8:
|
|
|
+ shift = 1;
|
|
|
+ for (i = 0; i < src_cnt; i++) {
|
|
|
+ u_desc_ctrl.value |= (1 << shift);
|
|
|
+ shift += 3;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!u_desc_ctrl.field.blk_ctrl && src_cnt > 4)
|
|
|
+ u_desc_ctrl.field.blk_ctrl = 0x1; /* use mini-desc */
|
|
|
+ }
|
|
|
+
|
|
|
+ u_desc_ctrl.field.dest_write_en = 1;
|
|
|
+ u_desc_ctrl.field.blk1_cmd_ctrl = 0x7; /* direct fill */
|
|
|
+ u_desc_ctrl.field.int_en = flags & DMA_PREP_INTERRUPT;
|
|
|
+ hw_desc->desc_ctrl = u_desc_ctrl.value;
|
|
|
+
|
|
|
+ return u_desc_ctrl.value;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void
|
|
|
+iop_desc_init_xor(struct iop_adma_desc_slot *desc, int src_cnt,
|
|
|
+ unsigned long flags)
|
|
|
+{
|
|
|
+ iop3xx_desc_init_xor(desc->hw_desc, src_cnt, flags);
|
|
|
+}
|
|
|
+
|
|
|
+/* return the number of operations */
|
|
|
+static inline int
|
|
|
+iop_desc_init_zero_sum(struct iop_adma_desc_slot *desc, int src_cnt,
|
|
|
+ unsigned long flags)
|
|
|
+{
|
|
|
+ int slot_cnt = desc->slot_cnt, slots_per_op = desc->slots_per_op;
|
|
|
+ struct iop3xx_desc_aau *hw_desc, *prev_hw_desc, *iter;
|
|
|
+ union {
|
|
|
+ u32 value;
|
|
|
+ struct iop3xx_aau_desc_ctrl field;
|
|
|
+ } u_desc_ctrl;
|
|
|
+ int i, j;
|
|
|
+
|
|
|
+ hw_desc = desc->hw_desc;
|
|
|
+
|
|
|
+ for (i = 0, j = 0; (slot_cnt -= slots_per_op) >= 0;
|
|
|
+ i += slots_per_op, j++) {
|
|
|
+ iter = iop_hw_desc_slot_idx(hw_desc, i);
|
|
|
+ u_desc_ctrl.value = iop3xx_desc_init_xor(iter, src_cnt, flags);
|
|
|
+ u_desc_ctrl.field.dest_write_en = 0;
|
|
|
+ u_desc_ctrl.field.zero_result_en = 1;
|
|
|
+ u_desc_ctrl.field.int_en = flags & DMA_PREP_INTERRUPT;
|
|
|
+ iter->desc_ctrl = u_desc_ctrl.value;
|
|
|
+
|
|
|
+ /* for the subsequent descriptors preserve the store queue
|
|
|
+ * and chain them together
|
|
|
+ */
|
|
|
+ if (i) {
|
|
|
+ prev_hw_desc =
|
|
|
+ iop_hw_desc_slot_idx(hw_desc, i - slots_per_op);
|
|
|
+ prev_hw_desc->next_desc =
|
|
|
+ (u32) (desc->async_tx.phys + (i << 5));
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return j;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void
|
|
|
+iop_desc_init_null_xor(struct iop_adma_desc_slot *desc, int src_cnt,
|
|
|
+ unsigned long flags)
|