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;