Subversion Repositories HelenOS

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
2726 vana 1
/*++
2
 
3
Copyright (c) 1998  Intel Corporation
4
 
5
Module Name:
6
 
7
    hw.c
8
 
9
Abstract:
10
 
11
    Debug library functions for Hardware IO access
12
 
13
 
14
 
15
Revision History
16
 
17
--*/
18
 
19
#include "lib.h"
20
 
21
 
22
EFI_STATUS
23
InitializeGlobalIoDevice (
24
        IN  EFI_DEVICE_PATH             *DevicePath,
25
        IN  EFI_GUID                    *Protocol,
26
        IN  CHAR8                       *ErrorStr,
27
        OUT EFI_DEVICE_IO_INTERFACE     **GlobalIoFncs
28
        )
29
/*++
30
 
31
Routine Description:
32
 
33
    Check to see if DevicePath exists for a given Protocol. Return Error if it
34
    exists. Return GlobalIoFuncs set match the DevicePath
35
 
36
  Arguments:
37
 
38
    DevicePath      - to operate on
39
    Protocol        - to check the DevicePath against
40
    ErrorStr        - ASCII string to display on error
41
    GlobalIoFncs    - Returned with DeviceIoProtocol for the DevicePath
42
 
43
Returns:
44
 
45
    Pass or Fail based on  wether GlobalIoFncs where found
46
 
47
--*/
48
{
49
    EFI_STATUS      Status;
50
    EFI_HANDLE      Handle;
51
 
52
    //
53
    // Check to see if this device path already has Protocol on it.
54
    //  if so we are loading recursivly and should exit with an error
55
    //
56
    Status = BS->LocateDevicePath (Protocol, &DevicePath, &Handle);
57
    if (!EFI_ERROR(Status)) {
58
        DEBUG ((D_INIT, "Device Already Loaded for %a device\n", ErrorStr));
59
        return EFI_LOAD_ERROR;
60
    }
61
 
62
    Status = BS->LocateDevicePath (&DeviceIoProtocol, &DevicePath, &Handle);
63
    if (!EFI_ERROR(Status)) {
64
        Status = BS->HandleProtocol (Handle, &DeviceIoProtocol, (VOID*)GlobalIoFncs);
65
    }
66
 
67
    ASSERT (!EFI_ERROR(Status));
68
    return Status;
69
}
70
 
71
UINT32
72
ReadPort (
73
        IN  EFI_DEVICE_IO_INTERFACE     *GlobalIoFncs,
74
        IN  EFI_IO_WIDTH                Width,
75
        IN  UINTN                       Port
76
        )
77
{
78
    UINT32       Data;
79
    EFI_STATUS  Status;
80
 
81
    Status = GlobalIoFncs->Io.Read (GlobalIoFncs, Width, (UINT64)Port, 1, &Data);
82
    ASSERT(!EFI_ERROR(Status));
83
    return Data;
84
}
85
 
86
UINT32
87
WritePort (
88
        IN  EFI_DEVICE_IO_INTERFACE     *GlobalIoFncs,
89
        IN  EFI_IO_WIDTH                Width,
90
        IN  UINTN                       Port,
91
        IN  UINTN                       Data
92
        )
93
{
94
    EFI_STATUS  Status;
95
 
96
    Status = GlobalIoFncs->Io.Write (GlobalIoFncs, Width, (UINT64)Port, 1, &Data);
97
    ASSERT(!EFI_ERROR(Status));
98
    return (UINT32)Data;
99
}
100
 
101
UINT32
102
ReadPciConfig (
103
        IN  EFI_DEVICE_IO_INTERFACE     *GlobalIoFncs,
104
        IN  EFI_IO_WIDTH                Width,
105
        IN  UINTN                       Address
106
        )
107
{
108
    UINT32       Data;
109
    EFI_STATUS  Status;
110
 
111
    Status = GlobalIoFncs->Pci.Read (GlobalIoFncs, Width, (UINT64)Address, 1, &Data);
112
    ASSERT(!EFI_ERROR(Status));
113
    return Data;
114
}
115
 
116
UINT32
117
WritePciConfig (
118
        IN  EFI_DEVICE_IO_INTERFACE     *GlobalIoFncs,
119
        IN  EFI_IO_WIDTH                Width,
120
        IN  UINTN                       Address,
121
        IN  UINTN                       Data
122
        )
123
{
124
    EFI_STATUS  Status;
125
 
126
    Status = GlobalIoFncs->Pci.Write (GlobalIoFncs, Width, (UINT64)Address, 1, &Data);
127
    ASSERT(!EFI_ERROR(Status));
128
    return (UINT32)Data;
129
}
130
 
131
 
132