hwctxt.cpp

来自「SAMSUNG S3C6410 CPU BSP for winmobile6」· C++ 代码 · 共 2,027 行 · 第 1/4 页

CPP
2,027 行
字号
1234

	// Alloc and Map DMAC1 SFR
	g_pDMAC1Reg = (S3C6410_DMAC_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_DMA1, sizeof(S3C6410_DMAC_REG), FALSE);
	if (g_pDMAC1Reg == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] MapRegisters() : g_pDMAC1Reg DrvLib_MapIoSpace() Failed\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

	// Alloc and Map IIS Interface SFR
#if		(CPU_NAME == S3C6410)
	g_pIISReg = (S3C6410_IIS_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_I2S_40, sizeof(S3C6410_IIS_REG), FALSE);
#elif	(CPU_NAME == S3C6400)
	g_pIISReg = (S3C6410_IIS_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_IIS0, sizeof(S3C6410_IIS_REG), FALSE);
#endif
	if (g_pIISReg == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] MapRegisters() : g_pIISReg DrvLib_MapIoSpace() Failed\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

	// Alloc and Map System Controller SFR
	g_pSysConReg = (S3C6410_SYSCON_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_SYSCON, sizeof(S3C6410_SYSCON_REG), FALSE);
	if (g_pSysConReg == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] MapRegisters() : g_pSysConReg DrvLib_MapIoSpace() Failed\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

CleanUp:

	if (bRet == FALSE)
	{
		UnMapRegisters();
	}

	WAV_MSG((_T("[WAV] --MapRegisters()\n\r")));

	return(TRUE);
}


BOOL
HardwareContext::UnMapRegisters()
{
	WAV_MSG((_T("[WAV] UnMapRegisters()\n\r")));

	if (g_pGPIOReg != NULL)
	{
		DrvLib_UnmapIoSpace((PVOID)g_pGPIOReg);
		g_pGPIOReg = NULL;
	}

	if (g_pIISReg != NULL)
	{
		DrvLib_UnmapIoSpace((PVOID)g_pIISReg);
		g_pIISReg = NULL;
	}

	if (g_pDMAC0Reg != NULL)
	{
		DrvLib_UnmapIoSpace((PVOID)g_pDMAC0Reg);
		g_pDMAC0Reg = NULL;
	}

	if (g_pDMAC1Reg != NULL)
	{
		DrvLib_UnmapIoSpace((PVOID)g_pDMAC1Reg);
		g_pDMAC1Reg = NULL;
	}

	if (g_pSysConReg != NULL)
	{
		DrvLib_UnmapIoSpace((PVOID)g_pSysConReg);
		g_pSysConReg = NULL;
	}

	return TRUE;
}


BOOL
HardwareContext::MapDMABuffers()
{
	PVOID pVirtDMABufferAddr = NULL;
	DMA_ADAPTER_OBJECT Adapter;
	BOOL bRet = TRUE;

	WAV_MSG((_T("[WAV] ++MapDMABuffers()\n\r")));

	memset(&Adapter, 0, sizeof(DMA_ADAPTER_OBJECT));
	Adapter.ObjectSize = sizeof(DMA_ADAPTER_OBJECT);
	Adapter.InterfaceType = Internal;

	// Allocate DMA Buffer
	pVirtDMABufferAddr = HalAllocateCommonBuffer(&Adapter, AUDIO_DMA_BUFFER_SIZE, &g_PhyDMABufferAddr, FALSE);
	if (pVirtDMABufferAddr == NULL)
	{
		WAV_MSG((_T("[WAV:ERR] MapDMABuffers() : DMA Buffer Allocation Failed\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

	// Setup the Physical Address of DMA Buffer Page Address
	m_OutputDMABufferPhyPage[0] = (UINT32)g_PhyDMABufferAddr.LowPart;
	m_OutputDMABufferPhyPage[1] = (UINT32)(g_PhyDMABufferAddr.LowPart+AUDIO_DMA_PAGE_SIZE);
	m_InputDMABufferPhyPage[0] = (UINT32)(g_PhyDMABufferAddr.LowPart+AUDIO_DMA_PAGE_SIZE*2);
	m_InputDMABufferPhyPage[1] = (UINT32)(g_PhyDMABufferAddr.LowPart+AUDIO_DMA_PAGE_SIZE*3);

	// Setup the Virtual Address of DMA Buffer Page Address
	m_OutputDMABufferVirPage[0] = (PBYTE)pVirtDMABufferAddr;
	m_OutputDMABufferVirPage[1] = (PBYTE)((UINT32)pVirtDMABufferAddr+AUDIO_DMA_PAGE_SIZE);
	m_InputDMABufferVirPage[0] = (PBYTE)((UINT32)pVirtDMABufferAddr+AUDIO_DMA_PAGE_SIZE*2);
	m_InputDMABufferVirPage[1] = (PBYTE)((UINT32)pVirtDMABufferAddr+AUDIO_DMA_PAGE_SIZE*3);

CleanUp:

	WAV_MSG((_T("[WAV] --MapDMABuffers() : %d\n\r"), bRet));

	return bRet;
}


BOOL
HardwareContext::UnMapDMABuffers()
{
	WAV_MSG((_T("[WAV] UnMapDMABuffers()\n\r")));

	if(m_OutputDMABufferVirPage[0])
	{
		PHYSICAL_ADDRESS PhysicalAddress;
		PhysicalAddress.LowPart = m_OutputDMABufferPhyPage[0];	// No Meaning just for compile

		HalFreeCommonBuffer(0, 0, PhysicalAddress, (PVOID)m_OutputDMABufferVirPage[0], FALSE);

		m_OutputDMABufferVirPage[0] = NULL;
		m_OutputDMABufferVirPage[1] = NULL;
		m_InputDMABufferVirPage[0] = NULL;
		m_InputDMABufferVirPage[1] = NULL;
	}

	return TRUE;
}


BOOL
HardwareContext::InitIIS()
{
	WAV_MSG((_T("[WAV] ++InitIIS() \n\r")));

	WAV_MSG((_T("[WAV] --InitIIS() \n\r")));

	return TRUE;
}


BOOL
HardwareContext::InitIISCodec()
{
	DWORD   dwErr = TRUE;
	DWORD   bytes = 0;

	WAV_MSG((_T("[WAV] ++InitIISCodec()\n\r")));

	if ( m_hI2C == INVALID_HANDLE_VALUE )
	{
		dwErr = GetLastError();
		WAV_ERR((_T("[WAV:ERR] InitIISCodec() : m_hI2C is INVALID_HANDLE_VALUE\n\r")));
		return FALSE;
	}

#if		(CPU_NAME == S3C6410)
	I2S_Init8580Driver();
#elif	(CPU_NAME == S3C6400)
	I2S_Init8753Driver();
#endif

	WAV_MSG((_T("[WAV] --InitIISCodec()\n\r")));

	return dwErr;
}


BOOL
HardwareContext::InitOutputDMA()
{
	BOOL bRet = TRUE;

	WAV_MSG((_T("[WAV] ++InitOutputDMA()\n\r")));

	if (!g_PhyDMABufferAddr.LowPart)
	{
		WAV_ERR((_T("[WAV:ERR] InitOutputDMA() : DMA Buffer is Not Allocated Yet\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

#if		(CPU_NAME == S3C6410)
	bRet = DMA_request_channel(&g_OutputDMA, DMA_I2S_V40_TX);
	if (bRet)
	{
		DMA_initialize_channel(&g_OutputDMA, TRUE);
		DMA_set_channel_source(&g_OutputDMA, m_OutputDMABufferPhyPage[0], WORD_UNIT, BURST_1, INCREASE);
		DMA_set_channel_destination(&g_OutputDMA, IIS_get_output_physical_buffer_address(IIS_CH_2), WORD_UNIT, BURST_1, FIXED);
		DMA_set_channel_transfer_size(&g_OutputDMA, AUDIO_DMA_PAGE_SIZE);
		DMA_initialize_LLI(&g_OutputDMA, 2);
		DMA_set_LLI_entry(&g_OutputDMA, 0, LLI_NEXT_ENTRY, m_OutputDMABufferPhyPage[0],
							IIS_get_output_physical_buffer_address(IIS_CH_2), AUDIO_DMA_PAGE_SIZE);
		DMA_set_LLI_entry(&g_OutputDMA, 1, LLI_FIRST_ENTRY, m_OutputDMABufferPhyPage[1],
							IIS_get_output_physical_buffer_address(IIS_CH_2), AUDIO_DMA_PAGE_SIZE);
		DMA_set_initial_LLI(&g_OutputDMA, 1);
	}
#elif	(CPU_NAME == S3C6400)
	bRet = DMA_request_channel(&g_OutputDMA, DMA_I2S0_TX);
	if (bRet)
	{
		DMA_initialize_channel(&g_OutputDMA, TRUE);
		DMA_set_channel_source(&g_OutputDMA, m_OutputDMABufferPhyPage[0], WORD_UNIT, BURST_1, INCREASE);
		DMA_set_channel_destination(&g_OutputDMA, IIS_get_output_physical_buffer_address(IIS_CH_0), WORD_UNIT, BURST_1, FIXED);
		DMA_set_channel_transfer_size(&g_OutputDMA, AUDIO_DMA_PAGE_SIZE);
		DMA_initialize_LLI(&g_OutputDMA, 2);
		DMA_set_LLI_entry(&g_OutputDMA, 0, LLI_NEXT_ENTRY, m_OutputDMABufferPhyPage[0],
							IIS_get_output_physical_buffer_address(IIS_CH_0), AUDIO_DMA_PAGE_SIZE);
		DMA_set_LLI_entry(&g_OutputDMA, 1, LLI_FIRST_ENTRY, m_OutputDMABufferPhyPage[1],
							IIS_get_output_physical_buffer_address(IIS_CH_0), AUDIO_DMA_PAGE_SIZE);
		DMA_set_initial_LLI(&g_OutputDMA, 1);
	}
#endif

CleanUp:

	WAV_MSG((_T("[WAV] --InitOutputDMA()\n\r")));

	return bRet;
}


BOOL HardwareContext::InitInputDMA()
{
	BOOL bRet = TRUE;

	WAV_MSG((_T("[WAV] ++InitInputDMA()\n\r")));

	if (!g_PhyDMABufferAddr.LowPart)
	{
		WAV_ERR((_T("[WAV:ERR] InitInputDMA() : DMA Buffer is Not Allocated Yet\n\r")));
		bRet = FALSE;
		goto CleanUp;
	}

#if		(CPU_NAME == S3C6410)
	bRet = DMA_request_channel(&g_InputDMA, DMA_I2S_V40_RX);
	if (bRet)
	{
		DMA_initialize_channel(&g_InputDMA, TRUE);
		DMA_set_channel_source(&g_InputDMA, IIS_get_input_physical_buffer_address(IIS_CH_2), WORD_UNIT, BURST_1, FIXED);
		DMA_set_channel_destination(&g_InputDMA, m_InputDMABufferPhyPage[0], WORD_UNIT, BURST_1, INCREASE);
		DMA_set_channel_transfer_size(&g_InputDMA, AUDIO_DMA_PAGE_SIZE);
		DMA_initialize_LLI(&g_InputDMA, 2);
		DMA_set_initial_LLI(&g_InputDMA, 1);
		DMA_set_LLI_entry(&g_InputDMA, 0, LLI_NEXT_ENTRY, IIS_get_input_physical_buffer_address(IIS_CH_2),
							m_InputDMABufferPhyPage[0], AUDIO_DMA_PAGE_SIZE);
		DMA_set_LLI_entry(&g_InputDMA, 1, LLI_FIRST_ENTRY, IIS_get_input_physical_buffer_address(IIS_CH_2),
							m_InputDMABufferPhyPage[1], AUDIO_DMA_PAGE_SIZE);
	}
#elif	(CPU_NAME == S3C6400)
	bRet = DMA_request_channel(&g_InputDMA, DMA_I2S0_RX);
	if (bRet)
	{
		DMA_initialize_channel(&g_InputDMA, TRUE);
		DMA_set_channel_source(&g_InputDMA, IIS_get_input_physical_buffer_address(IIS_CH_0), WORD_UNIT, BURST_1, FIXED);
		DMA_set_channel_destination(&g_InputDMA, m_InputDMABufferPhyPage[0], WORD_UNIT, BURST_1, INCREASE);
		DMA_set_channel_transfer_size(&g_InputDMA, AUDIO_DMA_PAGE_SIZE);
		DMA_initialize_LLI(&g_InputDMA, 2);
		DMA_set_initial_LLI(&g_InputDMA, 1);
		DMA_set_LLI_entry(&g_InputDMA, 0, LLI_NEXT_ENTRY, IIS_get_input_physical_buffer_address(IIS_CH_0),
							m_InputDMABufferPhyPage[0], AUDIO_DMA_PAGE_SIZE);
		DMA_set_LLI_entry(&g_InputDMA, 1, LLI_FIRST_ENTRY, IIS_get_input_physical_buffer_address(IIS_CH_0),
							m_InputDMABufferPhyPage[1], AUDIO_DMA_PAGE_SIZE);
	}
#endif

CleanUp:
	WAV_MSG((_T("[WAV] --InitInputDMA()\n\r")));

	return bRet;
}


BOOL
HardwareContext::InitInterruptThread()
{
	DWORD Irq;
	DWORD dwPriority;

	Irq = g_OutputDMA.dwIRQ;
	if (!KernelIoControl(IOCTL_HAL_REQUEST_SYSINTR, &Irq, sizeof(DWORD), &m_dwSysintrOutput, sizeof(DWORD), NULL))
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Output DMA IOCTL_HAL_REQUEST_SYSINTR Failed \n\r")));
		return FALSE;
	}

	Irq = g_InputDMA.dwIRQ;
	if (!KernelIoControl(IOCTL_HAL_REQUEST_SYSINTR, &Irq, sizeof(DWORD), &m_dwSysintrInput, sizeof(DWORD), NULL))
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Input DMA IOCTL_HAL_REQUEST_SYSINTR Failed \n\r")));
		return FALSE;
	}

	m_hOutputDMAInterrupt = CreateEvent(NULL, FALSE, FALSE, NULL);
	if (m_hOutputDMAInterrupt == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Output DMA CreateEvent() Failed \n\r")));
		return(FALSE);
	}

	m_hInputDMAInterrupt = CreateEvent(NULL, FALSE, FALSE, NULL);
	if (m_hInputDMAInterrupt == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Input DMA CreateEvent() Failed \n\r")));
		return(FALSE);
	}

	if (!InterruptInitialize(m_dwSysintrOutput, m_hOutputDMAInterrupt, NULL, 0))
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Output DMA InterruptInitialize() Failed \n\r")));
		return FALSE;
	}

	if (! InterruptInitialize(m_dwSysintrInput, m_hInputDMAInterrupt, NULL, 0))
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Input DMA InterruptInitialize() Failed \n\r")));
		return FALSE;
	}


	m_hOutputDMAInterruptThread = CreateThread((LPSECURITY_ATTRIBUTES)NULL, 0,
							(LPTHREAD_START_ROUTINE)CallInterruptThreadOutputDMA, this, 0, NULL);

	if (m_hOutputDMAInterruptThread == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Output DMA CreateThread() Failed \n\r")));
		return FALSE;
	}

	m_hInputDMAInterruptThread = CreateThread((LPSECURITY_ATTRIBUTES)NULL, 0,
							(LPTHREAD_START_ROUTINE)CallInterruptThreadInputDMA, this, 0, NULL);

	if (m_hInputDMAInterruptThread == NULL)
	{
		WAV_ERR((_T("[WAV:ERR] InitInterruptThread() : Input DMA CreateThread() Failed \n\r")));
		return FALSE;
	}

	dwPriority = GetInterruptThreadPriority();

	// Bump up the priority since the interrupt must be serviced immediately.
	CeSetThreadPriority(m_hOutputDMAInterruptThread, dwPriority);
	CeSetThreadPriority(m_hInputDMAInterruptThread, dwPriority);
	WAV_INF((_T("[WAV:INF] InitInterruptThread() : IST Priority = %d\n\r"), dwPriority));

	return(TRUE);
}

BOOL
HardwareContext::DeinitInterruptThread()
{
	return TRUE;
}


DWORD
HardwareContext::GetInterruptThreadPriority()
{
	HKEY hDevKey;
	DWORD dwValType;
	DWORD dwValLen;
	DWORD dwPrio = INTERRUPT_THREAD_PRIORITY_DEFAULT;
	LONG lResult;

	hDevKey = OpenDeviceKey((LPWSTR)m_DriverIndex);
	if (hDevKey)
	{
		dwValLen = sizeof(DWORD);
		lResult = RegQueryValueEx(hDevKey, TEXT("Priority256"), NULL, &dwValType, (PUCHAR)&dwPrio, &dwValLen);
		RegCloseKey(hDevKey);
	}
	else
	{
		WAV_ERR((_T("[WAV:ERR] GetInterruptThreadPriority() : OpenDeviceKey() Failed\n\r")));
	}

	return dwPrio;
}


ULONG
HardwareContext::TransferOutputBuffer(DWORD dwStatus)
{
	ULONG BytesTransferred = 0;
	ULONG BytesTotal = 0;

	dwStatus &= (DMA_DONEA|DMA_DONEB|DMA_BIU);

	//WAV_MSG((_T("[WAV] TransferOutputBuffer(0x%08x)\n\r"), dwStatus));

	switch (dwStatus)
	{
	case 0:
	case DMA_BIU:
		// No done bits set- must not be my interrupt
		return 0;
	case DMA_DONEA|DMA_DONEB|DMA_BIU:
		// Load B, then A
		BytesTransferred = FillOutputBuffer(OUTPUT_DMA_BUFFER1);
		// fall through
	case DMA_DONEA: // This should never happen!
	case DMA_DONEA|DMA_BIU:
		BytesTransferred += FillOutputBuffer(OUTPUT_DMA_BUFFER0);		// charlie, A => B
		break;
	case DMA_DONEA|DMA_DONEB:
		// Load A, then B
		BytesTransferred = FillOutputBuffer(OUTPUT_DMA_BUFFER0);
		BytesTransferred += FillOutputBuffer(OUTPUT_DMA_BUFFER1);
		break;
	case DMA_DONEB|DMA_BIU: // This should never happen!
	case DMA_DONEB:
		// Load B
		BytesTransferred += FillOutputBuffer(OUTPUT_DMA_BUFFER1);		// charlie, B => A
		break;
	}

	// If it was our interrupt, but we weren't able to transfer any bytes
	// (e.g. no full buffers ready to be emptied)
	// and all the output DMA buffers are now empty, then stop the output DMA
	BytesTotal = m_nOutByte[OUTPUT_DMA_BUFFER0]+m_nOutByte[OUTPUT_DMA_BUFFER1];

	if (BytesTotal == 0)
	{
		StopOutputDMA();
	}
	else
	{
		StartOutputDMA();		// for DMA resume when wake up
	}

	return BytesTransferred;
}


ULONG
HardwareContext::FillOutputBuffer(int nBufferNumber)
{
	ULONG BytesTransferred = 0;
	PBYTE pBufferStart = m_OutputDMABufferVirPage[nBufferNumber];
	PBYTE pBufferEnd = pBufferStart + AUDIO_DMA_PAGE_SIZE;
	PBYTE pBufferLast;

	//WAV_MSG((_T("[WAV] FillOutputBuffer(%d)\n\r"), nBufferNumber));

	__try
	{
		pBufferLast = m_OutputDeviceContext.TransferBuffer(pBufferStart, pBufferEnd, NULL);

		BytesTransferred = pBufferLast-pBufferStart;
		m_nOutByte[nBufferNumber] = BytesTransferred;

		// Enable if you need to clear the rest of the DMA buffer
		StreamContext::ClearBuffer(pBufferLast, pBufferEnd);

		if(nBufferNumber == OUTPUT_DMA_BUFFER0)			// Output Buffer A
		{
			m_OutputDMAStatus &= ~DMA_DONEA;
			m_OutputDMAStatus |= DMA_STRTA;
		}
		else								// Output Buffer B
		{
			m_OutputDMAStatus &= ~DMA_DONEB;
			m_OutputDMAStatus |= DMA_STRTB;
		}
	}
	__except(EXCEPTION_EXECUTE_HANDLER)
	{
		WAV_ERR((_T("[WAV:ERR] FillOutputBuffer() : Exception ccurs [%d]\n\r"), GetExceptionCode()));
		DEBUGMSG(ZONE_ERROR, (TEXT("WAVDEV2.DLL:TransferOutputBuffer() - EXCEPTION: %d"), GetExceptionCode()));
	}

	return BytesTransferred;
}


ULONG
HardwareContext::TransferInputBuffers(DWORD dwStatus)
{
	ULONG BytesTransferred=0;

	dwStatus &= (DMA_DONEA|DMA_DONEB|DMA_BIU);

	//WAV_MSG((_T("[WAV] TransferInputBuffers(0x%08x)\n\r"), dwStatus));

	switch (dwStatus)
	{
	case 0:
	case DMA_BIU:
1234

hwctxt.cpp - 源码说明

本页面展示了「SAMSUNG S3C6410 CPU BSP for winmobile6」中的 hwctxt.cpp 源码文件，采用 C++ 编程语言编写，共 2,027 行代码。您可以在线阅读完整代码内容，也可以返回资源详情页下载完整源码包进行本地学习和开发。

虫虫开发者社区收录了大量与S3C6410相关的技术资源，包括源代码、技术文档、电路图等，是电子工程师和嵌入式开发者的专业学习平台。

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?