d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

- Use x86bios_offset() instead of BIOS_PADDRTOVADDR() macro.[1]

Browse Source 
- Clear all registers before calling real mode interrupt handlers as we did
for dpms and vesa and re-enable the function as it should be fixed by this.
- Tidy up register access.  For example, when we call INT 0x15, AH=0xc0,
we used to initialize AX=0xc000 to clear AL at the same time but it is
very confusing.  We don't have to do this any more because we are explicitly
clearing all registers now.
- Check size of system configuration table although it is almost always 8.
This is to make sure we are not reading some random low physical memory.
Hopefully it is just zero in that case. :-)
- Fix some style nits and add more comments.

Submitted by:	paradox (ddkprog yahoo com)[1]
This commit is contained in:
jkim 2009-09-25 19:49:07 +00:00
parent 57ef38956f
commit 1e05d21cdd
1 changed files with 23 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

37
sys/dev/atkbdc/atkbd.c
View File

@ -44,7 +44,7 @@ __FBSDID("$FreeBSD$");
#include <machine/bus.h>
#include <machine/resource.h>
#if 0
#if defined(__i386__) || defined(__amd64__)
#include <machine/md_var.h>
#include <machine/psl.h>
#include <compat/x86bios/x86bios.h>
@ -1089,32 +1089,41 @@ atkbd_shutdown_final(void *v)
static int
get_typematic(keyboard_t *kbd)
{
#if 0
#if defined(__i386__) || defined(__amd64__)
/*
* Only some systems allow us to retrieve the keyboard repeat
* rate previously set via the BIOS...
*/
x86regs_t regs;
vm_offset_t p;
uint8_t *p;
regs.R_AX = 0xc000;
/* Is BIOS system configuration table supported? */
bzero(&regs, sizeof(regs));
regs.R_AH = 0xc0;
x86bios_intr(&regs, 0x15);
if ((regs.R_EFLG & PSL_C) || regs.R_AH)
return ENODEV;
p = BIOS_PADDRTOVADDR((regs.R_ES << 4) + regs.R_BX);
if ((readb(p + 6) & 0x40) == 0) /* int 16, function 0x09 supported? */
return ENODEV;
regs.R_AX = 0x0900;
if ((regs.R_FLG & PSL_C) || regs.R_AH)
return (ENODEV);
/* Is int 16, function 0x09 supported? */
p = x86bios_offset((regs.R_ES << 4) + regs.R_BX);
if (readw(p) < 5 || (readb(p + 6) & 0x40) == 0)
return (ENODEV);
/* Is int 16, function 0x0306 supported? */
bzero(&regs, sizeof(regs));
regs.R_AH = 0x09;
x86bios_intr(&regs, 0x16);
if ((regs.R_AL & 0x08) == 0) /* int 16, function 0x0306 supported? */
return ENODEV;
if ((regs.R_AL & 0x08) == 0)
return (ENODEV);
bzero(&regs, sizeof(regs));
regs.R_AX = 0x0306;
x86bios_intr(&regs, 0x16);
kbd->kb_delay1 = typematic_delay(regs.R_BH << 5);
kbd->kb_delay2 = typematic_rate(regs.R_BL);
return 0;
return (0);
#else
return ENODEV;
return (ENODEV);
#endif /* __i386__ || __amd64__ */
}