]> git.sur5r.net Git - u-boot/blob - arch/i386/lib/video_bios.c
x86: Add processor flags header from linux
[u-boot] / arch / i386 / lib / video_bios.c
1 /*
2  * (C) Copyright 2002
3  * Daniel Engström, Omicron Ceti AB, daniel@omicron.se
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23
24 #include <common.h>
25 #include <pci.h>
26 #include <malloc.h>
27 #include <asm/ptrace.h>
28 #include <asm/realmode.h>
29 #include <asm/io.h>
30 #include <asm/pci.h>
31
32 #undef PCI_BIOS_DEBUG
33 #undef VGA_BIOS_DEBUG
34
35 #ifdef  VGA_BIOS_DEBUG
36 #define PRINTF(fmt,args...)     printf (fmt ,##args)
37 #else
38 #define PRINTF(fmt,args...)
39 #endif
40
41 #ifdef CONFIG_PCI
42
43 #ifdef PCI_BIOS_DEBUG
44 #define RELOC_16(seg, off) *(u32*)(seg << 4 | (u32)&off)
45 extern u32 num_pci_bios_present;
46 extern u32 num_pci_bios_find_device;
47 extern u32 num_pci_bios_find_class;
48 extern u32 num_pci_bios_generate_special_cycle;
49 extern u32 num_pci_bios_read_cfg_byte;
50 extern u32 num_pci_bios_read_cfg_word;
51 extern u32 num_pci_bios_read_cfg_dword;
52 extern u32 num_pci_bios_write_cfg_byte;
53 extern u32 num_pci_bios_write_cfg_word;
54 extern u32 num_pci_bios_write_cfg_dword;
55 extern u32 num_pci_bios_get_irq_routing;
56 extern u32 num_pci_bios_set_irq;
57 extern u32 num_pci_bios_unknown_function;
58
59 void print_bios_bios_stat(void)
60 {
61         printf("16 bit functions:\n");
62         printf("pci_bios_present:                %d\n", RELOC_16(0xf000, num_pci_bios_present));
63         printf("pci_bios_find_device:            %d\n", RELOC_16(0xf000, num_pci_bios_find_device));
64         printf("pci_bios_find_class:             %d\n", RELOC_16(0xf000, num_pci_bios_find_class));
65         printf("pci_bios_generate_special_cycle: %d\n", RELOC_16(0xf000, num_pci_bios_generate_special_cycle));
66         printf("pci_bios_read_cfg_byte:          %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_byte));
67         printf("pci_bios_read_cfg_word:          %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_word));
68         printf("pci_bios_read_cfg_dword:         %d\n", RELOC_16(0xf000, num_pci_bios_read_cfg_dword));
69         printf("pci_bios_write_cfg_byte:         %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_byte));
70         printf("pci_bios_write_cfg_word:         %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_word));
71         printf("pci_bios_write_cfg_dword:        %d\n", RELOC_16(0xf000, num_pci_bios_write_cfg_dword));
72         printf("pci_bios_get_irq_routing:        %d\n", RELOC_16(0xf000, num_pci_bios_get_irq_routing));
73         printf("pci_bios_set_irq:                %d\n", RELOC_16(0xf000, num_pci_bios_set_irq));
74         printf("pci_bios_unknown_function:       %d\n", RELOC_16(0xf000, num_pci_bios_unknown_function));
75
76 }
77 #endif
78
79 #ifdef CONFIG_VIDEO
80
81 #define PCI_CLASS_VIDEO             3
82 #define PCI_CLASS_VIDEO_STD         0
83 #define PCI_CLASS_VIDEO_PROG_IF_VGA 0
84
85 static struct pci_device_id supported[] = {
86         {PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID},
87         {}
88 };
89
90 static u32 probe_pci_video(void)
91 {
92         pci_dev_t devbusfn;
93
94         if ((devbusfn = pci_find_devices(supported, 0) != -1)) {
95                 u32 old;
96                 u32 addr;
97
98                 /* PCI video device detected */
99                 printf("Found PCI VGA device at %02x.%02x.%x\n",
100                        PCI_BUS(devbusfn), PCI_DEV(devbusfn), PCI_FUNC(devbusfn));
101
102                 /* Enable I/O decoding as well, PCI viudeo boards
103                  * support I/O accesses, but they provide no
104                  * bar register for this since the ports are fixed.
105                  */
106                 pci_write_config_word(devbusfn, PCI_COMMAND, PCI_COMMAND_MEMORY | PCI_COMMAND_IO | PCI_COMMAND_MASTER);
107
108                 /* Test the ROM decoder, do the device support a rom? */
109                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
110                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, (u32)PCI_ROM_ADDRESS_MASK);
111                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
112                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
113
114                 if (!addr) {
115                         printf("PCI VGA have no ROM?\n");
116                         return 0;
117                 }
118
119                 /* device have a rom */
120                 if (pci_shadow_rom(devbusfn, (void*)0xc0000)) {
121                         printf("Shadowing of PCI VGA BIOS failed\n");
122                         return 0;
123                 }
124
125                 /* Now enable lagacy VGA port access */
126                 if (pci_enable_legacy_video_ports(pci_bus_to_hose(PCI_BUS(devbusfn)))) {
127                         printf("PCI VGA enable failed\n");
128                         return 0;
129                 }
130
131
132                 /* return the pci device info, that we'll need later */
133                 return PCI_BUS(devbusfn) << 8 |
134                         PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn)&7);
135         }
136
137         return 0;
138 }
139
140 static int probe_isa_video(void)
141 {
142         u32 ptr;
143         char *buf;
144
145         if (0 == (ptr = isa_map_rom(0xc0000, 0x8000))) {
146                 return -1;
147         }
148         if (NULL == (buf=malloc(0x8000))) {
149                 isa_unmap_rom(ptr);
150                 return -1;
151         }
152         if (readw(ptr) != 0xaa55) {
153                 free(buf);
154                 isa_unmap_rom(ptr);
155                 return -1;
156         }
157
158         /* shadow the rom */
159         memcpy(buf, (void*)ptr, 0x8000);
160         isa_unmap_rom(ptr);
161         memcpy((void*)0xc0000, buf, 0x8000);
162
163         free(buf);
164
165         return 0;
166 }
167
168 int video_bios_init(void)
169 {
170         struct pt_regs regs;
171
172         /* clear the video bios area in case we warmbooted */
173         memset((void*)0xc0000, 0, 0x8000);
174         memset(&regs, 0, sizeof(struct pt_regs));
175
176         if (probe_isa_video()) {
177                 /* No ISA board found, try the PCI bus */
178                 regs.eax = probe_pci_video();
179         }
180
181         /* Did we succeed in mapping any video bios */
182         if (readw(0xc0000) == 0xaa55) {
183                 int size;
184                 int i;
185                 u8 sum;
186
187                 PRINTF("Found video bios signature\n");
188                 size = 512*readb(0xc0002);
189                 PRINTF("size %d\n", size);
190                 sum=0;
191                 for (i=0;i<size;i++) {
192                         sum += readb(0xc0000 + i);
193                 }
194                 PRINTF("Checksum is %sOK\n",sum?"NOT ":"");
195                 if (sum) {
196                         return 1;
197                 }
198
199                 /* some video bioses (ATI Mach64) seem to think that
200                  * the original int 10 handler is always at
201                  * 0xf000:0xf065 , place an iret instruction there
202                  */
203                 writeb(0xcf, 0xff065);
204
205                 regs.esp = 0x8000;
206                 regs.xss = 0x2000;
207                 enter_realmode(0xc000, 3, &regs, &regs);
208                 PRINTF("INT 0x10 vector after:  %04x:%04x\n",
209                        readw(0x42), readw(0x40));
210                 PRINTF("BIOS returned %scarry\n", regs.eflags & 1?"":"NOT ");
211 #ifdef PCI_BIOS_DEBUG
212                 print_bios_bios_stat();
213 #endif
214                 return (regs.eflags & 1);
215
216         }
217
218         return 1;
219
220 }
221 #endif
222 #endif