int _set_gdma_ch(unsigned long dst, unsigned long src, unsigned int len, int burst_size, int soft_mode, int src_req_type, int dst_req_type, int src_burst_mode, int dst_burst_mode) { unsigned long data; //src GDMA_WRITE_REG(GDMA_SRC_REG(DMA_CHNUM), (src & 0x1fffffff)); //dst GDMA_WRITE_REG(GDMA_DST_REG(DMA_CHNUM), (dst & 0x1fffffff)); //control 1, data = 0; // data = (0 << CH_UNMASK_INTEBL_OFFSET); data |= ( DMA_CHNUM << NEXT_UNMASK_CH_OFFSET); data |= ( (soft_mode == 0) << CH_MASK_OFFSET); #if 0 #if defined (CONFIG_RALINK_RT3883) || defined (CONFIG_RALINK_RT3352) data |= (src_req_type << SRC_DMA_REQ_OFFSET); data |= (dst_req_type << DST_DMA_REQ_OFFSET); #endif #endif // frank added data |= (src_req_type << SRC_DMA_REQ_OFFSET); data |= (dst_req_type << DST_DMA_REQ_OFFSET); GDMA_WRITE_REG(GDMA_CTRL_REG1(DMA_CHNUM), data); // control data = (len << TRANS_CNT_OFFSET); #if 0 #ifdef CONFIG_RALINK_RT3052 data |= (src_req_type << SRC_DMA_REQ_OFFSET); data |= (dst_req_type << DST_DMA_REQ_OFFSET); #endif #endif data |= (src_burst_mode << SRC_BRST_MODE_OFFSET); data |= (dst_burst_mode << DST_BRST_MODE_OFFSET); data |= (burst_size << BRST_SIZE_OFFSET); // data |= (0 << INT_EBL_OFFSET); data |= ((soft_mode != 0) << MODE_SEL_OFFSET); data |= (0x01<<CH_EBL_OFFSET); GDMA_WRITE_REG(GDMA_CTRL_REG(DMA_CHNUM), data); return 1; }
int _GdmaReqEntryIns(GdmaReqEntry *NewEntry) { uint32_t Data=0; GDMA_PRINT("== << GDMA Control Reg (Channel=%d) >> ===\n", NewEntry->ChNum); GDMA_PRINT(" Channel Source Addr = %x \n", NewEntry->Src); GDMA_PRINT(" Channel Dest Addr = %x \n", NewEntry->Dst); GDMA_PRINT(" Transfer Count=%d\n", NewEntry->TransCount); GDMA_PRINT(" Source DMA Req= DMA_REQ%d\n", NewEntry->SrcReqNum); GDMA_PRINT(" Dest DMA Req= DMA_REQ%d\n", NewEntry->DstReqNum); GDMA_PRINT(" Source Burst Mode=%s\n", NewEntry->SrcBurstMode ? "Fix" : "Inc"); GDMA_PRINT(" Dest Burst Mode=%s\n", NewEntry->DstBurstMode ? "Fix" : "Inc"); GDMA_PRINT(" Burst Size=%s\n", NewEntry->BurstSize ==0 ? "1 transfer" : \ NewEntry->BurstSize ==1 ? "2 transfer" :\ NewEntry->BurstSize ==2 ? "4 transfer" :\ NewEntry->BurstSize ==3 ? "8 transfer" :\ NewEntry->BurstSize ==4 ? "16 transfer" :\ "Error"); GDMA_PRINT(" Hardware/Software Mode = %s\n", NewEntry->SoftMode ? "Soft" : "Hw"); GDMA_PRINT("== << GDMA Control Reg1 (Channel=%d) >> =\n", NewEntry->ChNum); GDMA_PRINT("Channel Done Interrput=%s\n", (NewEntry->DoneIntCallback!=NULL) ? "Enable" : "Disable"); GDMA_PRINT("Channel Unmasked Int=%s\n", (NewEntry->UnMaskIntCallback!=NULL) ? "Enable" : "Disable"); #if !defined (CONFIG_RALINK_RT3052) && !defined (CONFIG_RALINK_RT3883) GDMA_PRINT("Coherent Interrupt =%s\n", (NewEntry->CoherentIntEbl==1)? "Enable" : "Disable"); #endif GDMA_PRINT("Next Unmasked Channel=%d\n", NewEntry->NextUnMaskCh); GDMA_PRINT("Channel Mask=%d\n", NewEntry->ChMask); GDMA_PRINT("========================================\n"); GDMA_WRITE_REG(GDMA_SRC_REG(NewEntry->ChNum), NewEntry->Src); GDMA_PRINT("SrcAddr: Write %0X to %X\n", \ NewEntry->Src, GDMA_SRC_REG(NewEntry->ChNum)); GDMA_WRITE_REG(GDMA_DST_REG(NewEntry->ChNum), NewEntry->Dst); GDMA_PRINT("DstAddr: Write %0X to %X\n", \ NewEntry->Dst, GDMA_DST_REG(NewEntry->ChNum)); Data |= ( (NewEntry->NextUnMaskCh) << NEXT_UNMASK_CH_OFFSET); Data |= ( NewEntry->ChMask << CH_MASK_OFFSET); #if !defined (CONFIG_RALINK_RT3052) && !defined (CONFIG_RALINK_RT3883) Data |= ( NewEntry->CoherentIntEbl << COHERENT_INT_EBL_OFFSET); #endif if(NewEntry->UnMaskIntCallback!=NULL) { Data |= (0x01<<CH_UNMASKINT_EBL_OFFSET); GdmaUnMaskIntCallback[NewEntry->ChNum] = NewEntry->UnMaskIntCallback; } #if defined (CONFIG_RALINK_RT3883) || defined (CONFIG_RALINK_RT3352) || defined (CONFIG_RALINK_RT5350) Data |= (NewEntry->SrcReqNum << SRC_DMA_REQ_OFFSET); Data |= (NewEntry->DstReqNum << DST_DMA_REQ_OFFSET); #endif GDMA_WRITE_REG(GDMA_CTRL_REG1(NewEntry->ChNum), Data); GDMA_PRINT("CTRL1: Write %08X to %8X\n", Data, GDMA_CTRL_REG1(NewEntry->ChNum)); Data = ((NewEntry->TransCount) << TRANS_CNT_OFFSET); #if defined (CONFIG_RALINK_RT3052) Data |= (NewEntry->SrcReqNum << SRC_DMA_REQ_OFFSET); Data |= (NewEntry->DstReqNum << DST_DMA_REQ_OFFSET); #endif Data |= (NewEntry->SrcBurstMode << SRC_BRST_MODE_OFFSET); Data |= (NewEntry->DstBurstMode << DST_BRST_MODE_OFFSET); Data |= (NewEntry->BurstSize << BRST_SIZE_OFFSET); if(NewEntry->DoneIntCallback!=NULL) { Data |= (0x01<<CH_DONEINT_EBL_OFFSET); GdmaDoneIntCallback[NewEntry->ChNum] = NewEntry->DoneIntCallback; } if(NewEntry->SoftMode) { Data |= (0x01<<MODE_SEL_OFFSET); } Data |= (0x01<<CH_EBL_OFFSET); GDMA_WRITE_REG(GDMA_CTRL_REG(NewEntry->ChNum), Data); GDMA_PRINT("CTRL: Write %08X to %8X\n", Data, GDMA_CTRL_REG(NewEntry->ChNum)); //if there is no interrupt handler, this function will //return 1 until GDMA done. if(NewEntry->DoneIntCallback==NULL) { //wait for GDMA processing done #if defined (CONFIG_RALINK_RT3052) while((GDMA_READ_REG(RALINK_GDMAISTS) & (0x1<<NewEntry->ChNum))==0); //write 1 clear GDMA_WRITE_REG(RALINK_GDMAISTS, 1<< NewEntry->ChNum); #elif defined (CONFIG_RALINK_RT3883) || defined (CONFIG_RALINK_RT3352) || defined (CONFIG_RALINK_RT5350) while((GDMA_READ_REG(RALINK_GDMA_DONEINT) & (0x1<<NewEntry->ChNum))==0); //write 1 clear GDMA_WRITE_REG(RALINK_GDMA_DONEINT, 1<< NewEntry->ChNum); #endif } return 1; }