3 * Stäubli Faverges - <www.staubli.com>
4 * Pierre AUBERT p.aubert@staubli.com
7 * Martin Krause TQ-Systems GmbH martin.krause@tqs.de
9 * SPDX-License-Identifier: GPL-2.0+
13 * Basic video support for SMI SM501 "Voyager" graphic controller
23 #define read8(ptrReg) \
24 *(volatile unsigned char *)(sm501.isaBase + ptrReg)
26 #define write8(ptrReg,value) \
27 *(volatile unsigned char *)(sm501.isaBase + ptrReg) = value
29 #define read16(ptrReg) \
30 (*(volatile unsigned short *)(sm501.isaBase + ptrReg))
32 #define write16(ptrReg,value) \
33 (*(volatile unsigned short *)(sm501.isaBase + ptrReg) = value)
35 #define read32(ptrReg) \
36 (*(volatile unsigned int *)(sm501.isaBase + ptrReg))
38 #define write32(ptrReg, value) \
39 (*(volatile unsigned int *)(sm501.isaBase + ptrReg) = value)
43 void write_be32(int off
, unsigned int val
)
45 out_be32((unsigned __iomem
*)(sm501
.isaBase
+ off
), val
);
48 void write_le32(int off
, unsigned int val
)
50 out_le32((unsigned __iomem
*)(sm501
.isaBase
+ off
), val
);
53 void (*write_reg32
)(int off
, unsigned int val
) = write_be32
;
55 /*-----------------------------------------------------------------------------
57 *-----------------------------------------------------------------------------
59 static void SmiSetRegs (void)
62 * The content of the chipset register depends on the board (clocks,
65 const SMI_REGS
*preg
= board_get_regs ();
67 write_reg32 (preg
->Index
, preg
->Value
);
69 * Insert a delay between
76 #ifdef CONFIG_VIDEO_SM501_PCI
77 static struct pci_device_id sm501_pci_tbl
[] = {
78 { PCI_VENDOR_ID_SMI
, PCI_DEVICE_ID_SMI_501
},
84 * We do not enforce board code to provide empty/unused
85 * functions for this driver and define weak default
88 unsigned int __board_video_init (void)
93 unsigned int board_video_init (void)
94 __attribute__((weak
, alias("__board_video_init")));
96 unsigned int __board_video_get_fb (void)
101 unsigned int board_video_get_fb (void)
102 __attribute__((weak
, alias("__board_video_get_fb")));
104 void __board_validate_screen (unsigned int base
)
108 void board_validate_screen (unsigned int base
)
109 __attribute__((weak
, alias("__board_validate_screen")));
111 /*-----------------------------------------------------------------------------
113 *-----------------------------------------------------------------------------
115 void *video_hw_init (void)
117 #ifdef CONFIG_VIDEO_SM501_PCI
118 unsigned int pci_mem_base
, pci_mmio_base
;
120 unsigned short device_id
;
126 memset (&sm501
, 0, sizeof (GraphicDevice
));
128 #ifdef CONFIG_VIDEO_SM501_PCI
131 /* Look for SM501/SM502 chips */
132 devbusfn
= pci_find_devices(sm501_pci_tbl
, 0);
134 printf ("PCI Controller not found.\n");
139 pci_write_config_dword (devbusfn
, PCI_COMMAND
,
140 (PCI_COMMAND_MEMORY
| PCI_COMMAND_IO
));
141 pci_read_config_word (devbusfn
, PCI_DEVICE_ID
, &device_id
);
142 pci_read_config_dword (devbusfn
, PCI_REVISION_ID
, &id
);
143 pci_read_config_dword (devbusfn
, PCI_BASE_ADDRESS_0
, &pci_mem_base
);
144 pci_read_config_dword (devbusfn
, PCI_BASE_ADDRESS_1
, &pci_mmio_base
);
145 sm501
.frameAdrs
= pci_mem_to_phys (devbusfn
, pci_mem_base
);
146 sm501
.isaBase
= pci_mem_to_phys (devbusfn
, pci_mmio_base
);
149 write_reg32
= write_le32
;
151 mem
= in_le32 ((unsigned __iomem
*)(sm501
.isaBase
+ 0x10));
152 mem
= (mem
& 0x0000e000) >> 13;
173 printf ("PCI SM50%d %d MB\n", ((id
& 0xff) == 0xC0) ? 2 : 1, mem
);
177 * Initialization of the access to the graphic chipset Retreive base
178 * address of the chipset (see board/RPXClassic/eccx.c)
180 if (!sm501
.isaBase
) {
181 sm501
.isaBase
= board_video_init ();
186 if (!sm501
.frameAdrs
) {
187 sm501
.frameAdrs
= board_video_get_fb ();
188 if (!sm501
.frameAdrs
)
192 sm501
.winSizeX
= board_get_width ();
193 sm501
.winSizeY
= board_get_height ();
195 #if defined(CONFIG_VIDEO_SM501_8BPP)
196 sm501
.gdfIndex
= GDF__8BIT_INDEX
;
197 sm501
.gdfBytesPP
= 1;
199 #elif defined(CONFIG_VIDEO_SM501_16BPP)
200 sm501
.gdfIndex
= GDF_16BIT_565RGB
;
201 sm501
.gdfBytesPP
= 2;
203 #elif defined(CONFIG_VIDEO_SM501_32BPP)
204 sm501
.gdfIndex
= GDF_32BIT_X888RGB
;
205 sm501
.gdfBytesPP
= 4;
207 #error Unsupported SM501 BPP
210 sm501
.memSize
= sm501
.winSizeX
* sm501
.winSizeY
* sm501
.gdfBytesPP
;
212 /* Load Smi registers */
215 /* (see board/RPXClassic/RPXClassic.c) */
216 board_validate_screen (sm501
.isaBase
);
218 /* Clear video memory */
220 vm
= (unsigned int *)sm501
.frameAdrs
;