]> git.sur5r.net Git - u-boot/blob - lib_i386/video_bios.c
mpc83xx: add "fsl,soc" and "fsl,immr" compatible fixups
[u-boot] / lib_i386 / 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 #define PCI_CLASS_VIDEO             3
80 #define PCI_CLASS_VIDEO_STD         0
81 #define PCI_CLASS_VIDEO_PROG_IF_VGA 0
82
83
84 static u32 probe_pci_video(void)
85 {
86         pci_dev_t devbusfn;
87
88         if ((devbusfn = pci_find_class(PCI_CLASS_VIDEO,
89                                        PCI_CLASS_VIDEO_STD,
90                                        PCI_CLASS_VIDEO_PROG_IF_VGA, 0)) != -1) {
91                 u32 old;
92                 u32 addr;
93
94                 /* PCI video device detected */
95                 printf("Found PCI VGA device at %02x.%02x.%x\n",
96                        PCI_BUS(devbusfn), PCI_DEV(devbusfn), PCI_FUNC(devbusfn));
97
98                 /* Enable I/O decoding as well, PCI viudeo boards
99                  * support I/O accesses, but they provide no
100                  * bar register for this since the ports are fixed.
101                  */
102                 pci_write_config_word(devbusfn, PCI_COMMAND, PCI_COMMAND_MEMORY | PCI_COMMAND_IO | PCI_COMMAND_MASTER);
103
104                 /* Test the ROM decoder, do the device support a rom? */
105                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old);
106                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, PCI_ROM_ADDRESS_MASK);
107                 pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr);
108                 pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old);
109
110                 if (!addr) {
111                         printf("PCI VGA have no ROM?\n");
112                         return 0;
113                 }
114
115                 /* device have a rom */
116                 if (pci_shadow_rom(devbusfn, (void*)0xc0000)) {
117                         printf("Shadowing of PCI VGA BIOS failed\n");
118                         return 0;
119                 }
120
121                 /* Now enable lagacy VGA port access */
122                 if (pci_enable_legacy_video_ports(pci_bus_to_hose(PCI_BUS(devbusfn)))) {
123                         printf("PCI VGA enable failed\n");
124                         return 0;
125                 }
126
127
128                 /* return the pci device info, that we'll need later */
129                 return PCI_BUS(devbusfn) << 8 |
130                         PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn)&7);
131         }
132
133         return 0;
134 }
135
136
137 #endif
138
139 static int probe_isa_video(void)
140 {
141         u32 ptr;
142         char *buf;
143
144         if (0 == (ptr = isa_map_rom(0xc0000, 0x8000))) {
145                 return -1;
146         }
147         if (NULL == (buf=malloc(0x8000))) {
148                 isa_unmap_rom(ptr);
149                 return -1;
150         }
151         if (readw(ptr) != 0xaa55) {
152                 free(buf);
153                 isa_unmap_rom(ptr);
154                 return -1;
155         }
156
157         /* shadow the rom */
158         memcpy(buf, (void*)ptr, 0x8000);
159         isa_unmap_rom(ptr);
160         memcpy((void*)0xc0000, buf, 0x8000);
161
162         free(buf);
163
164         return 0;
165 }
166
167 int video_bios_init(void)
168 {
169         struct pt_regs regs;
170
171         /* clear the video bios area in case we warmbooted */
172         memset((void*)0xc0000, 0, 0x8000);
173         memset(&regs, 0, sizeof(struct pt_regs));
174
175         if (probe_isa_video()) {
176                 /* No ISA board found, try the PCI bus */
177                 regs.eax = probe_pci_video();
178         }
179
180         /* Did we succeed in mapping any video bios */
181         if (readw(0xc0000) == 0xaa55) {
182                 int size;
183                 int i;
184                 u8 sum;
185
186                 PRINTF("Found video bios signature\n");
187                 size = 512*readb(0xc0002);
188                 PRINTF("size %d\n", size);
189                 sum=0;
190                 for (i=0;i<size;i++) {
191                         sum += readb(0xc0000 + i);
192                 }
193                 PRINTF("Checksum is %sOK\n",sum?"NOT ":"");
194                 if (sum) {
195                         return 1;
196                 }
197
198                 /* some video bioses (ATI Mach64) seem to think that
199                  * the original int 10 handler is always at
200                  * 0xf000:0xf065 , place an iret instruction there
201                  */
202                 writeb(0xcf, 0xff065);
203
204                 regs.esp = 0x8000;
205                 regs.xss = 0x2000;
206                 enter_realmode(0xc000, 3, &regs, &regs);
207                 PRINTF("INT 0x10 vector after:  %04x:%04x\n",
208                        readw(0x42), readw(0x40));
209                 PRINTF("BIOS returned %scarry\n", regs.eflags & 1?"":"NOT ");
210 #ifdef PCI_BIOS_DEBUG
211                 print_bios_bios_stat();
212 #endif
213                 return (regs.eflags & 1);
214
215         }
216
217         return 1;
218
219 }