ReactOS 0.4.15-dev-7918-g2a2556c
pchw.c File Reference
#include <freeldr.h>
#include <debug.h>
Include dependency graph for pchw.c:

Go to the source code of this file.

Macros

#define MILLISEC   (10)
 
#define PRECISION   (8)
 
#define CLOCK_TICK_RATE   1193182
 
#define HZ   (100)
 
#define LATCH   (CLOCK_TICK_RATE / HZ)
 

Functions

 DBG_DEFAULT_CHANNEL (HWDETECT)
 
PCHAR GetHarddiskIdentifier (UCHAR DriveNumber)
 
static VOID __StallExecutionProcessor (ULONG Loops)
 
VOID StallExecutionProcessor (ULONG Microseconds)
 
static ULONG Read8254Timer (VOID)
 
static VOID WaitFor8254Wraparound (VOID)
 
VOID HalpCalibrateStallExecution (VOID)
 
static UCHAR GetFloppyType (UCHAR DriveNumber)
 
static PVOID GetInt1eTable (VOID)
 
static VOID DetectBiosFloppyPeripheral (PCONFIGURATION_COMPONENT_DATA ControllerKey)
 
static PCONFIGURATION_COMPONENT_DATA DetectBiosFloppyController (PCONFIGURATION_COMPONENT_DATA BusKey)
 
VOID DetectBiosDisks (PCONFIGURATION_COMPONENT_DATA SystemKey, PCONFIGURATION_COMPONENT_DATA BusKey)
 
VOID FrLdrCheckCpuCompatibility (VOID)
 

Variables

static unsigned int delay_count = 1
 
UCHAR PcBiosDiskCount
 
GET_HARDDISK_CONFIG_DATA GetHarddiskConfigurationData = NULL
 

Macro Definition Documentation

◆ CLOCK_TICK_RATE

#define CLOCK_TICK_RATE   1193182

Definition at line 33 of file pchw.c.

◆ HZ

#define HZ   (100)

Definition at line 36 of file pchw.c.

◆ LATCH

#define LATCH   (CLOCK_TICK_RATE / HZ)

Definition at line 37 of file pchw.c.

◆ MILLISEC

#define MILLISEC   (10)

Definition at line 27 of file pchw.c.

◆ PRECISION

#define PRECISION   (8)

Definition at line 28 of file pchw.c.

Function Documentation

◆ __StallExecutionProcessor()

static VOID __StallExecutionProcessor ( ULONG  Loops)
static

Definition at line 54 of file pchw.c.

55{
56 register volatile unsigned int i;
57 for (i = 0; i < Loops; i++);
58}
GLsizei GLenum const GLvoid GLsizei GLenum GLbyte GLbyte GLbyte GLdouble GLdouble GLdouble GLfloat GLfloat GLfloat GLint GLint GLint GLshort GLshort GLshort GLubyte GLubyte GLubyte GLuint GLuint GLuint GLushort GLushort GLushort GLbyte GLbyte GLbyte GLbyte GLdouble GLdouble GLdouble GLdouble GLfloat GLfloat GLfloat GLfloat GLint GLint GLint GLint GLshort GLshort GLshort GLshort GLubyte GLubyte GLubyte GLubyte GLuint GLuint GLuint GLuint GLushort GLushort GLushort GLushort GLboolean const GLdouble const GLfloat const GLint const GLshort const GLbyte const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLdouble const GLfloat const GLfloat const GLint const GLint const GLshort const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort const GLdouble const GLfloat const GLint const GLshort GLenum GLenum GLenum GLfloat GLenum GLint GLenum GLenum GLenum GLfloat GLenum GLenum GLint GLenum GLfloat GLenum GLint GLint GLushort GLenum GLenum GLfloat GLenum GLenum GLint GLfloat const GLubyte GLenum GLenum GLenum const GLfloat GLenum GLenum const GLint GLenum GLint GLint GLsizei GLsizei GLint GLenum GLenum const GLvoid GLenum GLenum const GLfloat GLenum GLenum const GLint GLenum GLenum const GLdouble GLenum GLenum const GLfloat GLenum GLenum const GLint GLsizei GLuint GLfloat GLuint GLbitfield GLfloat GLint GLuint GLboolean GLenum GLfloat GLenum GLbitfield GLenum GLfloat GLfloat GLint GLint const GLfloat GLenum GLfloat GLfloat GLint GLint GLfloat GLfloat GLint GLint const GLfloat GLint GLfloat GLfloat GLint GLfloat GLfloat GLint GLfloat GLfloat const GLdouble const GLfloat const GLdouble const GLfloat GLint i
Definition: glfuncs.h:248

Referenced by HalpCalibrateStallExecution(), and StallExecutionProcessor().

◆ DBG_DEFAULT_CHANNEL()

DBG_DEFAULT_CHANNEL ( HWDETECT  )

◆ DetectBiosDisks()

VOID DetectBiosDisks ( PCONFIGURATION_COMPONENT_DATA  SystemKey,
PCONFIGURATION_COMPONENT_DATA  BusKey 
)

Definition at line 344 of file pchw.c.

346{
347 PCONFIGURATION_COMPONENT_DATA ControllerKey, DiskKey;
348 PCM_PARTIAL_RESOURCE_LIST PartialResourceList;
349 PCM_INT13_DRIVE_PARAMETER Int13Drives;
350 GEOMETRY Geometry;
351 UCHAR DiskCount, DriveNumber;
352 USHORT i;
353 ULONG Size;
354
355 /* The pre-enumeration of the BIOS disks was already done in InitializeBootDevices() */
356 DiskCount = PcBiosDiskCount;
357
358 /* Use the floppy disk controller as our controller */
359 ControllerKey = DetectBiosFloppyController(BusKey);
360 if (!ControllerKey)
361 {
362 ERR("Failed to detect BIOS disk controller\n");
363 return;
364 }
365
366 /* Allocate resource descriptor */
368 sizeof(CM_INT13_DRIVE_PARAMETER) * DiskCount;
369 PartialResourceList = FrLdrHeapAlloc(Size, TAG_HW_RESOURCE_LIST);
370 if (PartialResourceList == NULL)
371 {
372 ERR("Failed to allocate resource descriptor\n");
373 return;
374 }
375
376 /* Initialize resource descriptor */
377 RtlZeroMemory(PartialResourceList, Size);
378 PartialResourceList->Version = 1;
379 PartialResourceList->Revision = 1;
380 PartialResourceList->Count = 1;
381 PartialResourceList->PartialDescriptors[0].Type = CmResourceTypeDeviceSpecific;
382 PartialResourceList->PartialDescriptors[0].ShareDisposition = 0;
383 PartialResourceList->PartialDescriptors[0].Flags = 0;
384 PartialResourceList->PartialDescriptors[0].u.DeviceSpecificData.DataSize =
385 sizeof(CM_INT13_DRIVE_PARAMETER) * DiskCount;
386
387 /* Get harddisk Int13 geometry data */
388 Int13Drives = (PVOID)(((ULONG_PTR)PartialResourceList) + sizeof(CM_PARTIAL_RESOURCE_LIST));
389 for (i = 0; i < DiskCount; i++)
390 {
391 DriveNumber = 0x80 + i;
392
393 if (MachDiskGetDriveGeometry(DriveNumber, &Geometry))
394 {
395 Int13Drives[i].DriveSelect = DriveNumber;
396 Int13Drives[i].MaxCylinders = Geometry.Cylinders - 1;
397 Int13Drives[i].SectorsPerTrack = (USHORT)Geometry.Sectors;
398 Int13Drives[i].MaxHeads = (USHORT)Geometry.Heads - 1;
399 Int13Drives[i].NumberDrives = DiskCount;
400
401 TRACE("Disk %x: %u Cylinders %u Heads %u Sectors %u Bytes\n",
402 DriveNumber,
403 Geometry.Cylinders - 1,
404 Geometry.Heads - 1,
405 Geometry.Sectors,
406 Geometry.BytesPerSector);
407 }
408 }
409
410 /* Update the 'System' key's configuration data with BIOS INT13h information */
411 FldrSetConfigurationData(SystemKey, PartialResourceList, Size);
412
413 /* Create and fill subkey for each harddisk */
414 for (i = 0; i < DiskCount; i++)
415 {
417
418 DriveNumber = 0x80 + i;
419
420 /* Get disk values */
421 PartialResourceList = GetHarddiskConfigurationData(DriveNumber, &Size);
422 Identifier = GetHarddiskIdentifier(DriveNumber);
423
424 /* Create disk key */
425 FldrCreateComponentKey(ControllerKey,
428 Output | Input,
429 i,
430 0xFFFFFFFF,
432 PartialResourceList,
433 Size,
434 &DiskKey);
435 }
436}
VOID FldrCreateComponentKey(_In_ PCONFIGURATION_COMPONENT_DATA SystemNode, _In_ CONFIGURATION_CLASS Class, _In_ CONFIGURATION_TYPE Type, _In_ IDENTIFIER_FLAG Flags, _In_ ULONG Key, _In_ ULONG Affinity, _In_ PCSTR IdentifierString, _In_ PCM_PARTIAL_RESOURCE_LIST ResourceList, _In_ ULONG Size, _Out_ PCONFIGURATION_COMPONENT_DATA *ComponentKey)
Definition: archwsup.c:198
VOID FldrSetConfigurationData(_Inout_ PCONFIGURATION_COMPONENT_DATA ComponentData, _In_ PCM_PARTIAL_RESOURCE_LIST ResourceList, _In_ ULONG Size)
Definition: archwsup.c:124
@ Identifier
Definition: asmpp.cpp:95
#define ERR(fmt,...)
Definition: debug.h:110
#define MachDiskGetDriveGeometry(Drive, Geom)
Definition: machine.h:128
FORCEINLINE PVOID FrLdrHeapAlloc(SIZE_T MemorySize, ULONG Tag)
Definition: mm.h:174
#define NULL
Definition: types.h:112
struct _CM_PARTIAL_RESOURCE_LIST CM_PARTIAL_RESOURCE_LIST
#define CmResourceTypeDeviceSpecific
Definition: hwresource.cpp:127
GET_HARDDISK_CONFIG_DATA GetHarddiskConfigurationData
Definition: pchw.c:45
static PCONFIGURATION_COMPONENT_DATA DetectBiosFloppyController(PCONFIGURATION_COMPONENT_DATA BusKey)
Definition: pchw.c:272
PCHAR GetHarddiskIdentifier(UCHAR DriveNumber)
Definition: hwdisk.c:252
UCHAR PcBiosDiskCount
Definition: hwdisk.c:46
unsigned short USHORT
Definition: pedump.c:61
@ PeripheralClass
Definition: arc.h:95
@ DiskPeripheral
Definition: arc.h:129
@ Input
Definition: arc.h:84
@ Output
Definition: arc.h:85
#define TRACE(s)
Definition: solgame.cpp:4
union _CM_PARTIAL_RESOURCE_DESCRIPTOR::@393 u
struct _CM_PARTIAL_RESOURCE_DESCRIPTOR::@393::@402 DeviceSpecificData
CM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptors[1]
Definition: hwresource.cpp:119
Definition: disk.h:25
ULONG BytesPerSector
Definition: disk.h:29
ULONG Sectors
Definition: disk.h:28
ULONG Cylinders
Definition: disk.h:26
ULONG Heads
Definition: disk.h:27
void * PVOID
Definition: typedefs.h:50
const char * PCSTR
Definition: typedefs.h:52
#define RtlZeroMemory(Destination, Length)
Definition: typedefs.h:262
uint32_t ULONG_PTR
Definition: typedefs.h:65
uint32_t ULONG
Definition: typedefs.h:59
#define TAG_HW_RESOURCE_LIST
Definition: uefidisk.c:15
_Must_inspect_result_ _In_ WDFDEVICE _In_ PWDF_DEVICE_PROPERTY_DATA _In_ DEVPROPTYPE _In_ ULONG Size
Definition: wdfdevice.h:4533
struct _CM_INT13_DRIVE_PARAMETER CM_INT13_DRIVE_PARAMETER
unsigned char UCHAR
Definition: xmlstorage.h:181

Referenced by DetectIsaBios().

◆ DetectBiosFloppyController()

static PCONFIGURATION_COMPONENT_DATA DetectBiosFloppyController ( PCONFIGURATION_COMPONENT_DATA  BusKey)
static

Definition at line 272 of file pchw.c.

273{
274 PCONFIGURATION_COMPONENT_DATA ControllerKey;
275 PCM_PARTIAL_RESOURCE_LIST PartialResourceList;
276 PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor;
277 ULONG Size;
278 ULONG FloppyCount;
279
280 FloppyCount = MachGetFloppyCount();
281 TRACE("Floppy count: %u\n", FloppyCount);
282
283 /* Always create a BIOS disk controller, no matter if we have floppy drives or not */
286 PartialResourceList = FrLdrHeapAlloc(Size, TAG_HW_RESOURCE_LIST);
287 if (PartialResourceList == NULL)
288 {
289 ERR("Failed to allocate resource descriptor\n");
290 return NULL;
291 }
292
293 /* Initialize resource descriptor */
294 RtlZeroMemory(PartialResourceList, Size);
295 PartialResourceList->Version = 1;
296 PartialResourceList->Revision = 1;
297 PartialResourceList->Count = 3;
298
299 /* Set IO Port */
300 PartialDescriptor = &PartialResourceList->PartialDescriptors[0];
301 PartialDescriptor->Type = CmResourceTypePort;
303 PartialDescriptor->Flags = CM_RESOURCE_PORT_IO;
304 PartialDescriptor->u.Port.Start.LowPart = 0x03F0;
305 PartialDescriptor->u.Port.Start.HighPart = 0x0;
306 PartialDescriptor->u.Port.Length = 8;
307
308 /* Set Interrupt */
309 PartialDescriptor = &PartialResourceList->PartialDescriptors[1];
310 PartialDescriptor->Type = CmResourceTypeInterrupt;
312 PartialDescriptor->Flags = CM_RESOURCE_INTERRUPT_LATCHED;
313 PartialDescriptor->u.Interrupt.Level = 6;
314 PartialDescriptor->u.Interrupt.Vector = 6;
315 PartialDescriptor->u.Interrupt.Affinity = 0xFFFFFFFF;
316
317 /* Set DMA channel */
318 PartialDescriptor = &PartialResourceList->PartialDescriptors[2];
319 PartialDescriptor->Type = CmResourceTypeDma;
321 PartialDescriptor->Flags = 0;
322 PartialDescriptor->u.Dma.Channel = 2;
323 PartialDescriptor->u.Dma.Port = 0;
324
325 /* Create floppy disk controller */
329 Output | Input,
330 0x0,
331 0xFFFFFFFF,
332 NULL,
333 PartialResourceList,
334 Size,
335 &ControllerKey);
336
337 if (FloppyCount)
338 DetectBiosFloppyPeripheral(ControllerKey);
339
340 return ControllerKey;
341}
@ DiskController
Definition: arcname.c:68
#define MachGetFloppyCount()
Definition: machine.h:124
#define CmResourceTypeDma
Definition: hwresource.cpp:126
#define CmResourceTypePort
Definition: hwresource.cpp:123
#define CmResourceTypeInterrupt
Definition: hwresource.cpp:124
#define CM_RESOURCE_PORT_IO
Definition: cmtypes.h:109
#define CM_RESOURCE_INTERRUPT_LATCHED
Definition: cmtypes.h:144
static VOID DetectBiosFloppyPeripheral(PCONFIGURATION_COMPONENT_DATA ControllerKey)
Definition: pchw.c:200
@ ControllerClass
Definition: arc.h:94
struct _CM_PARTIAL_RESOURCE_DESCRIPTOR::@393::@396 Interrupt
struct _CM_PARTIAL_RESOURCE_DESCRIPTOR::@393::@395 Port
struct _CM_PARTIAL_RESOURCE_DESCRIPTOR::@393::@399 Dma
@ CmResourceShareDeviceExclusive
Definition: cmtypes.h:241
@ CmResourceShareUndetermined
Definition: cmtypes.h:240

Referenced by DetectBiosDisks().

◆ DetectBiosFloppyPeripheral()

static VOID DetectBiosFloppyPeripheral ( PCONFIGURATION_COMPONENT_DATA  ControllerKey)
static

Definition at line 200 of file pchw.c.

201{
202 PCM_PARTIAL_RESOURCE_LIST PartialResourceList;
203 PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor;
204 PCM_FLOPPY_DEVICE_DATA FloppyData;
205 CHAR Identifier[20];
206 PCONFIGURATION_COMPONENT_DATA PeripheralKey;
207 ULONG Size;
208 UCHAR FloppyNumber;
209 UCHAR FloppyType;
210 ULONG MaxDensity[6] = {0, 360, 1200, 720, 1440, 2880};
211 PUCHAR Ptr;
212
213 for (FloppyNumber = 0; FloppyNumber < 2; FloppyNumber++)
214 {
215 FloppyType = GetFloppyType(FloppyNumber);
216
217 if ((FloppyType > 5) || (FloppyType == 0))
218 continue;
219
220 if (!DiskResetController(FloppyNumber))
221 continue;
222
223 Ptr = GetInt1eTable();
224
225 /* Set 'Identifier' value */
226 RtlStringCbPrintfA(Identifier, sizeof(Identifier), "FLOPPY%d", FloppyNumber + 1);
227
229 sizeof(CM_FLOPPY_DEVICE_DATA);
230 PartialResourceList = FrLdrHeapAlloc(Size, TAG_HW_RESOURCE_LIST);
231 if (PartialResourceList == NULL)
232 {
233 ERR("Failed to allocate resource descriptor! Ignoring remaining floppy peripherals. (FloppyNumber = %u)\n",
234 FloppyNumber);
235 return;
236 }
237
238 RtlZeroMemory(PartialResourceList, Size);
239 PartialResourceList->Version = 1;
240 PartialResourceList->Revision = 1;
241 PartialResourceList->Count = 1;
242
243 PartialDescriptor = &PartialResourceList->PartialDescriptors[0];
244 PartialDescriptor->Type = CmResourceTypeDeviceSpecific;
246 PartialDescriptor->u.DeviceSpecificData.DataSize = sizeof(CM_FLOPPY_DEVICE_DATA);
247
248 FloppyData = (PVOID)(((ULONG_PTR)PartialResourceList) + sizeof(CM_PARTIAL_RESOURCE_LIST));
249 FloppyData->Version = 2;
250 FloppyData->Revision = 0;
251 FloppyData->MaxDensity = MaxDensity[FloppyType];
252 FloppyData->MountDensity = 0;
253 RtlCopyMemory(&FloppyData->StepRateHeadUnloadTime, Ptr, 11);
254 FloppyData->MaximumTrackValue = (FloppyType == 1) ? 39 : 79;
255 FloppyData->DataTransferRate = 0;
256
257 FldrCreateComponentKey(ControllerKey,
260 Input | Output,
261 FloppyNumber,
262 0xFFFFFFFF,
264 PartialResourceList,
265 Size,
266 &PeripheralKey);
267 }
268}
_Must_inspect_result_ _In_ PFSRTL_PER_STREAM_CONTEXT Ptr
Definition: fsrtlfuncs.h:898
NTSTRSAFEVAPI RtlStringCbPrintfA(_Out_writes_bytes_(cbDest) _Always_(_Post_z_) NTSTRSAFE_PSTR pszDest, _In_ size_t cbDest, _In_ _Printf_format_string_ NTSTRSAFE_PCSTR pszFormat,...)
Definition: ntstrsafe.h:1148
BOOLEAN DiskResetController(UCHAR DriveNumber)
Definition: pcdisk.c:180
static PVOID GetInt1eTable(VOID)
Definition: pchw.c:190
static UCHAR GetFloppyType(UCHAR DriveNumber)
Definition: pchw.c:173
@ FloppyDiskPeripheral
Definition: arc.h:130
UCHAR StepRateHeadUnloadTime
Definition: cmtypes.h:489
#define RtlCopyMemory(Destination, Source, Length)
Definition: typedefs.h:263
unsigned char * PUCHAR
Definition: typedefs.h:53
struct _CM_FLOPPY_DEVICE_DATA CM_FLOPPY_DEVICE_DATA
char CHAR
Definition: xmlstorage.h:175

Referenced by DetectBiosFloppyController().

◆ FrLdrCheckCpuCompatibility()

VOID FrLdrCheckCpuCompatibility ( VOID  )

Definition at line 439 of file pchw.c.

440{
441 INT CpuInformation[4] = {-1};
442 ULONG NumberOfIds;
443
444 /* Check if the processor first supports ID 1 */
445 __cpuid(CpuInformation, 0);
446
447 NumberOfIds = CpuInformation[0];
448
449 if (NumberOfIds == 0)
450 {
452 __FILE__,
453 __LINE__,
454 "ReactOS requires the CPUID instruction to return "
455 "more than one supported ID.\n\n");
456 }
457
458 /* NumberOfIds will be greater than 1 if the processor is new enough */
459 if (NumberOfIds == 1)
460 {
461 INT ProcessorFamily;
462
463 /* Get information */
464 __cpuid(CpuInformation, 1);
465
466 ProcessorFamily = (CpuInformation[0] >> 8) & 0xF;
467
468 /* If it's Family 4 or lower, bugcheck */
469 if (ProcessorFamily < 5)
470 {
472 __FILE__,
473 __LINE__,
474 "Processor is too old (family %u < 5)\n"
475 "ReactOS requires a Pentium-level processor or newer.",
476 ProcessorFamily);
477 }
478 }
479}
VOID FrLdrBugCheckWithMessage(ULONG BugCode, PCHAR File, ULONG Line, PSTR Format,...)
Definition: debug.c:28
@ MISSING_HARDWARE_REQUIREMENTS
Definition: debug.h:141
PPC_QUAL void __cpuid(int CPUInfo[], const int InfoType)
Definition: intrin_ppc.h:682
int32_t INT
Definition: typedefs.h:58

◆ GetFloppyType()

static UCHAR GetFloppyType ( UCHAR  DriveNumber)
static

Definition at line 173 of file pchw.c.

174{
175 UCHAR Data;
176
177 WRITE_PORT_UCHAR((PUCHAR)0x70, 0x10);
178 Data = READ_PORT_UCHAR((PUCHAR)0x71);
179
180 if (DriveNumber == 0)
181 return Data >> 4;
182 else if (DriveNumber == 1)
183 return Data & 0x0F;
184
185 return 0;
186}
#define READ_PORT_UCHAR(p)
Definition: pc98vid.h:22
#define WRITE_PORT_UCHAR(p, d)
Definition: pc98vid.h:21

Referenced by DetectBiosFloppyPeripheral().

◆ GetHarddiskIdentifier()

PCHAR GetHarddiskIdentifier ( UCHAR  DriveNumber)

Definition at line 252 of file hwdisk.c.

253{
254 return PcDiskIdentifier[DriveNumber - FIRST_BIOS_DISK];
255}
static CHAR PcDiskIdentifier[32][20]
Definition: hwdisk.c:47
#define FIRST_BIOS_DISK
Definition: hwdisk.c:31

Referenced by DetectBiosDisks().

◆ GetInt1eTable()

static PVOID GetInt1eTable ( VOID  )
static

Definition at line 190 of file pchw.c.

191{
192 PUSHORT SegPtr = (PUSHORT)0x7A;
193 PUSHORT OfsPtr = (PUSHORT)0x78;
194
195 return (PVOID)((ULONG_PTR)(((ULONG)(*SegPtr)) << 4) + (ULONG)(*OfsPtr));
196}
#define ULONG_PTR
Definition: config.h:101
uint16_t * PUSHORT
Definition: typedefs.h:56

Referenced by DetectBiosFloppyPeripheral().

◆ HalpCalibrateStallExecution()

VOID HalpCalibrateStallExecution ( VOID  )

Definition at line 105 of file pchw.c.

106{
107 ULONG i;
108 ULONG calib_bit;
109 ULONG CurCount;
110
111 /* Initialise timer interrupt with MILLISECOND ms interval */
112 WRITE_PORT_UCHAR((PUCHAR)0x43, 0x34); /* binary, mode 2, LSB/MSB, ch 0 */
113 WRITE_PORT_UCHAR((PUCHAR)0x40, LATCH & 0xff); /* LSB */
114 WRITE_PORT_UCHAR((PUCHAR)0x40, LATCH >> 8); /* MSB */
115
116 /* Stage 1: Coarse calibration */
117
118 delay_count = 1;
119
120 do
121 {
122 /* Next delay count to try */
123 delay_count <<= 1;
124
126
127 /* Do the delay */
129
130 CurCount = Read8254Timer();
131 }
132 while (CurCount > LATCH / 2);
133
134 /* Get bottom value for delay */
135 delay_count >>= 1;
136
137 /* Stage 2: Fine calibration */
138
139 /* Which bit are we going to test */
140 calib_bit = delay_count;
141
142 for (i = 0; i < PRECISION; i++)
143 {
144 /* Next bit to calibrate */
145 calib_bit >>= 1;
146
147 /* If we have done all bits, stop */
148 if (!calib_bit) break;
149
150 /* Set the bit in delay_count */
151 delay_count |= calib_bit;
152
154
155 /* Do the delay */
157
158 CurCount = Read8254Timer();
159 /* If a tick has passed, turn the calibrated bit back off */
160 if (CurCount <= LATCH / 2)
161 delay_count &= ~calib_bit;
162 }
163
164 /* We're finished: Do the finishing touches */
165
166 /* Calculate delay_count for 1ms */
167 delay_count /= (MILLISEC / 2);
168}
#define MILLISEC
Definition: pchw.c:27
static VOID WaitFor8254Wraparound(VOID)
Definition: pchw.c:81
static VOID __StallExecutionProcessor(ULONG Loops)
Definition: pchw.c:54
#define PRECISION
Definition: pchw.c:28
#define LATCH
Definition: pchw.c:37
static unsigned int delay_count
Definition: pchw.c:39
static ULONG Read8254Timer(VOID)
Definition: pchw.c:68

Referenced by HalInitSystem(), and MachInit().

◆ Read8254Timer()

static ULONG Read8254Timer ( VOID  )
static

Definition at line 68 of file pchw.c.

69{
71
72 WRITE_PORT_UCHAR((PUCHAR)0x43, 0x00);
74 Count |= READ_PORT_UCHAR((PUCHAR)0x40) << 8;
75
76 return Count;
77}
int Count
Definition: noreturn.cpp:7

Referenced by HalpCalibrateStallExecution(), and WaitFor8254Wraparound().

◆ StallExecutionProcessor()

◆ WaitFor8254Wraparound()

static VOID WaitFor8254Wraparound ( VOID  )
static

Definition at line 81 of file pchw.c.

82{
83 ULONG CurCount;
84 ULONG PrevCount = ~0;
85 LONG Delta;
86
87 CurCount = Read8254Timer();
88
89 do
90 {
91 PrevCount = CurCount;
92 CurCount = Read8254Timer();
93 Delta = CurCount - PrevCount;
94
95 /*
96 * This limit for delta seems arbitrary, but it isn't, it's
97 * slightly above the level of error a buggy Mercury/Neptune
98 * chipset timer can cause.
99 */
100 }
101 while (Delta < 300);
102}
long LONG
Definition: pedump.c:60
static ULONG Delta
Definition: xboxvideo.c:33

Referenced by HalpCalibrateStallExecution().

Variable Documentation

◆ delay_count

unsigned int delay_count = 1
static

Definition at line 39 of file pchw.c.

Referenced by HalpCalibrateStallExecution(), and StallExecutionProcessor().

◆ GetHarddiskConfigurationData

GET_HARDDISK_CONFIG_DATA GetHarddiskConfigurationData = NULL

Definition at line 45 of file pchw.c.

Referenced by DetectBiosDisks(), PcHwDetect(), and XboxHwDetect().

◆ PcBiosDiskCount

UCHAR PcBiosDiskCount
extern

Definition at line 46 of file hwdisk.c.

Referenced by DetectBiosDisks().