Fix a minor compile-time errors when INVARIANTS is not defined.
[dragonfly.git] / sys / i386 / i386 / elan-mmcr.c
CommitLineData
984263bc
MD
1/*
2 * ----------------------------------------------------------------------------
3 * "THE BEER-WARE LICENSE" (Revision 42):
4 * <phk@FreeBSD.org> wrote this file. As long as you retain this notice you
5 * can do whatever you want with this stuff. If we meet some day, and you think
6 * this stuff is worth it, you can buy me a beer in return. Poul-Henning Kamp
7 * ----------------------------------------------------------------------------
8 *
9 * $FreeBSD: src/sys/i386/i386/elan-mmcr.c,v 1.6.2.1 2002/09/17 22:39:53 sam Exp $
1de703da 10 * $DragonFly: src/sys/i386/i386/Attic/elan-mmcr.c,v 1.2 2003/06/17 04:28:35 dillon Exp $
984263bc
MD
11 * The AMD Elan sc520 is a system-on-chip gadget which is used in embedded
12 * kind of things, see www.soekris.com for instance, and it has a few quirks
13 * we need to deal with.
14 * Unfortunately we cannot identify the gadget by CPUID output because it
15 * depends on strapping options and only the stepping field may be useful
16 * and those are undocumented from AMDs side.
17 *
18 * So instead we recognize the on-chip host-PCI bridge and call back from
19 * sys/i386/pci/pci_bus.c to here if we find it.
20 */
21
22#include <sys/param.h>
23#include <sys/systm.h>
24#include <sys/kernel.h>
25#include <sys/conf.h>
26#include <sys/proc.h>
27#include <sys/sysctl.h>
28#include <sys/time.h>
29
30#include <machine/md_var.h>
31
32#include <vm/vm.h>
33#include <vm/pmap.h>
34
35uint16_t *elan_mmcr;
36
37
38static unsigned
39elan_get_timecount(struct timecounter *tc)
40{
41 return (elan_mmcr[0xc84 / 2]);
42}
43
44static struct timecounter elan_timecounter = {
45 elan_get_timecount,
46 0,
47 0xffff,
48 33333333 / 4,
49 "ELAN"
50};
51
52void
53init_AMD_Elan_sc520(void)
54{
55 u_int new;
56 int i;
57
58 if (bootverbose)
59 printf("Doing h0h0magic for AMD Elan sc520\n");
60 elan_mmcr = pmap_mapdev(0xfffef000, 0x1000);
61
62 /*-
63 * The i8254 is driven with a nonstandard frequency which is
64 * derived thusly:
65 * f = 32768 * 45 * 25 / 31 = 1189161.29...
66 * We use the sysctl to get the timecounter etc into whack.
67 */
68
69 new = 1189161;
70 i = kernel_sysctlbyname(curproc, "machdep.i8254_freq",
71 NULL, 0,
72 &new, sizeof new,
73 NULL);
74 if (bootverbose)
75 printf("sysctl machdep.i8254_freq=%d returns %d\n", new, i);
76
77 /* Start GP timer #2 and use it as timecounter, hz permitting */
78 elan_mmcr[0xc82 / 2] = 0xc001;
79 init_timecounter(&elan_timecounter);
80}
81
82
83/*
84 * Device driver initialization stuff
85 */
86
87static d_open_t elan_open;
88static d_close_t elan_close;
89static d_ioctl_t elan_ioctl;
90static d_mmap_t elan_mmap;
91
92#define CDEV_MAJOR 100 /* Share with xrpu */
93static struct cdevsw elan_cdevsw = {
94 /* open */ elan_open,
95 /* close */ elan_close,
96 /* read */ noread,
97 /* write */ nowrite,
98 /* ioctl */ elan_ioctl,
99 /* poll */ nopoll,
100 /* mmap */ elan_mmap,
101 /* strategy */ nostrategy,
102 /* name */ "elan",
103 /* maj */ CDEV_MAJOR,
104 /* dump */ nodump,
105 /* psize */ nopsize,
106 /* flags */ 0,
107};
108
109static int
110elan_open(dev_t dev, int flag, int mode, struct proc *p)
111{
112 return (0);
113}
114
115static int
116elan_close(dev_t dev, int flag, int mode, struct proc *p)
117{
118 return (0);
119}
120
121static int
122elan_mmap(dev_t dev, vm_offset_t offset, int nprot)
123{
124 if (offset >= 0x1000)
125 return (-1);
126 return (i386_btop(0xfffef000));
127}
128
129static int
130elan_ioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
131{
132 return(ENOENT);
133}
134
135static void
136elan_drvinit(void)
137{
138
139 if (elan_mmcr == NULL)
140 return;
141 printf("Elan-mmcr driver: MMCR at %p\n", elan_mmcr);
142 make_dev(&elan_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "elan-mmcr");
143 return;
144}
145
146SYSINIT(elan, SI_SUB_PSEUDO, SI_ORDER_MIDDLE+CDEV_MAJOR,elan_drvinit,NULL);