⭐ 欢迎来到虫虫下载站! | 📦 资源下载 📁 资源专辑 ℹ️ 关于我们
⭐ 虫虫下载站

📄 tmman.c

📁 wince host 和 target PCI驱动程序
💻 C
📖 第 1 页 / 共 3 页
字号:
		KernelMode,
		FALSE,
		NULL );
}

VOID	tmmanDeviceWaitForStop ( TMManDeviceObject* TMManDevice )
{
	KeWaitForSingleObject (
		&TMManDevice->StopEvent,
		Executive,
		KernelMode,
		FALSE,
		NULL );
}

//////////////////////////////////////////////////////////////////////////////
//
//	HELPER DATA ACCESS FUNCTIONS
//
//////////////////////////////////////////////////////////////////////////////

BOOLEAN RegistryReadDWORD ( 
	HANDLE	RegistryHandle, 
	PWCHAR	ValueName,
	PULONG	ValuePtr )
{
	ULONG	BytesXfered;	
	NTSTATUS	Status;
	UNICODE_STRING	UnicodeValueName;
	PUCHAR	PartialInformation[sizeof(KEY_VALUE_PARTIAL_INFORMATION) + sizeof(ULONG)];


	RtlInitUnicodeString (&UnicodeValueName, ValueName );

	Status = ZwQueryValueKey(
		RegistryHandle,
		&UnicodeValueName,
		KeyValuePartialInformation,
		(PVOID)PartialInformation,
		sizeof(KEY_VALUE_PARTIAL_INFORMATION) + sizeof(ULONG),
		&BytesXfered );

    if ( NT_SUCCESS ( Status ) && 
		((PKEY_VALUE_PARTIAL_INFORMATION)PartialInformation)->DataLength == sizeof(ULONG) ) 
	{
		*ValuePtr = *((PULONG)&((PKEY_VALUE_PARTIAL_INFORMATION)PartialInformation)->Data[0]);
		return TRUE;
    } 
	else 
	{
		return FALSE;
    }
}


BOOLEAN
InitBridge ( 
	halParameters* Config )
{

	ULONG	Data;

	Data = 0x06;


	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x44,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}



	Data = 0x00001000;

	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x50,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR Mem BAR:FAIL\n"));
		return FALSE;
	}


	Data = 0xFFFFFFFF;

	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x54,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}


	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->SystemBaseAddress, 
		(ULONG)0x58,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}



	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->SDRAMBaseAddress, 
		(ULONG)0x98,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}


	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->MMIOBaseAddress, 
		(ULONG)0x9C,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}


	Data = 0x00000000;

	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0xA4,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}


	Data = 0xFFFF0000;

	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x90,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitBridge:HalSetBusDataByOffset:Secondary CSR IO BAR:FAIL\n"));
		return FALSE;
	}



	return TRUE /* TMOK */;
}

/*
	This function will configure the TMX000 device behind the DEC Bridge
	and also extract the relevant information about the TMX000 device
	into the HalParametrs structure.
*/
BOOLEAN 
InitTriMedia (
	halParameters* Config )
{

	ULONG	ShiftIndex;
	ULONG	TriMediaAccessAddress;
	ULONG	Data;
	
	/* search secondary for Trimedia */
	for ( ShiftIndex = 0 ; ShiftIndex < 16 ; ShiftIndex++ )
	{
		TriMediaAccessAddress = (0x00010000 << ShiftIndex);

		Data = TriMediaAccessAddress;
		/* Config Address Register Type 0 Address */
		if ( HalSetBusDataByOffset (
			PCIConfiguration,
			(ULONG)Config->BusNumber,
			Config->SlotNumber.u.AsULONG,
			&Data, 
			(ULONG)0x80,					// register offset in config space
			sizeof (ULONG) ) != sizeof ( ULONG ) )
		{
			DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
			return FALSE;
		}


		/* Config Address Register Type 0 Address */
		if ( HalGetBusDataByOffset (
			PCIConfiguration,
			(ULONG)Config->BusNumber,
			Config->SlotNumber.u.AsULONG,
			&Config->TMDeviceVendorID, 
			(ULONG)0x84,					// register offset in config space
			sizeof (ULONG) ) != sizeof ( ULONG ) )
		{
			DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
			return FALSE;
		}

		DPF(0,("InitTriMedia:TriMediaAccessAddress[0x%x]:DeviceVendorID[0x%x]\n",
			TriMediaAccessAddress, Config->TMDeviceVendorID ));

		
		if ( (  Config->TMDeviceVendorID == ( ( constTMMANTM1000DeviceID << 16 ) | constTMMANTM1000VendorID ) ) || 
			( Config->TMDeviceVendorID == ( ( constTMMANTM2000DeviceID << 16 ) | constTMMANTM2000VendorID ) ) ||
			( Config->TMDeviceVendorID == ( ( constTMMANTM1300DeviceID << 16 ) | constTMMANTM1300VendorID ) ) )
		{
			break;
		}
	}

	if ( (  Config->TMDeviceVendorID != ( ( constTMMANTM1000DeviceID << 16 ) | constTMMANTM1000VendorID ) ) && 
		( Config->TMDeviceVendorID != ( ( constTMMANTM2000DeviceID << 16 ) | constTMMANTM2000VendorID ) ) &&
		( Config->TMDeviceVendorID != ( ( constTMMANTM1300DeviceID << 16 ) | constTMMANTM1300VendorID ) ) )
	{
			return FALSE;
	}

	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x00000008;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}


	/* Config Address Register Type 0 Address */
	if ( HalGetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->TMClassRevisionID, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}


	///////////////////////////////////////////////////////////////////////
	// read the subsystem and subsystem vendor ID.
	Data = TriMediaAccessAddress | 0x0000002C;


	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}


	/* Config Address Register Type 0 Address */
	if ( HalGetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->TMSubsystemID, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}

	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x0000000C;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}

	Data = 0x00000000;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}


	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x00000010;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}

	Data = 0x00000000;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->SDRAMBaseAddress, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}


	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x00000014;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}

	Data = 0x00000000;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->MMIOBaseAddress, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}




	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x0000003C;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}

	Data = 0x00000000;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Config->InterruptVector, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}


	///////////////////////////////////////////////////////////////////////
	Data = TriMediaAccessAddress | 0x00000004;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x80,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalSetBusDataByOffset:Secondary Command Status Write:FAIL\n"));
		return FALSE;
	}

	Data = 0x00000006;

	/* Config Address Register Type 0 Address */
	if ( HalSetBusDataByOffset (
		PCIConfiguration,
		(ULONG)Config->BusNumber,
		Config->SlotNumber.u.AsULONG,
		&Data, 
		(ULONG)0x84,					// register offset in config space
		sizeof (ULONG) ) != sizeof ( ULONG ) )
	{
		DPF(0,("InitTriMedia:HalGetBusDataByOffset:Secondary Vendor Device ID:FAIL\n"));
		return FALSE;
	}



	return TRUE; /* TMOK */;
}

⌨️ 快捷键说明

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