/*----------------------------------------------------------------------------- * video_hw_init -- *----------------------------------------------------------------------------- */ void *video_hw_init (void) { unsigned int *vm, i; memset (&sm501, 0, sizeof (GraphicDevice)); /* * Initialization of the access to the graphic chipset Retreive base * address of the chipset (see board/RPXClassic/eccx.c) */ if ((sm501.isaBase = board_video_init ()) == 0) { return (NULL); } if ((sm501.frameAdrs = board_video_get_fb ()) == 0) { return (NULL); } sm501.winSizeX = board_get_width (); sm501.winSizeY = board_get_height (); #if defined(CONFIG_VIDEO_SM501_8BPP) sm501.gdfIndex = GDF__8BIT_INDEX; sm501.gdfBytesPP = 1; #elif defined(CONFIG_VIDEO_SM501_16BPP) sm501.gdfIndex = GDF_16BIT_565RGB; sm501.gdfBytesPP = 2; #elif defined(CONFIG_VIDEO_SM501_32BPP) sm501.gdfIndex = GDF_32BIT_X888RGB; sm501.gdfBytesPP = 4; #else #error Unsupported SM501 BPP #endif sm501.memSize = sm501.winSizeX * sm501.winSizeY * sm501.gdfBytesPP; /* Load Smi registers */ SmiSetRegs (); /* (see board/RPXClassic/RPXClassic.c) */ board_validate_screen (sm501.isaBase); /* Clear video memory */ i = sm501.memSize/4; vm = (unsigned int *)sm501.frameAdrs; while(i--) *vm++ = 0; return (&sm501); }
/*----------------------------------------------------------------------------- * video_hw_init -- *----------------------------------------------------------------------------- */ void *video_hw_init (void) { #ifdef CONFIG_VIDEO_SM501_PCI unsigned int pci_mem_base, pci_mmio_base; unsigned int id; unsigned short device_id; pci_dev_t devbusfn; int mem; #endif unsigned int *vm, i; memset (&sm501, 0, sizeof (GraphicDevice)); #ifdef CONFIG_VIDEO_SM501_PCI printf("Video: "); /* Look for SM501/SM502 chips */ devbusfn = pci_find_devices(sm501_pci_tbl, 0); if (devbusfn < 0) { printf ("PCI Controller not found.\n"); goto not_pci; } /* Setup */ pci_write_config_dword (devbusfn, PCI_COMMAND, (PCI_COMMAND_MEMORY | PCI_COMMAND_IO)); pci_read_config_word (devbusfn, PCI_DEVICE_ID, &device_id); pci_read_config_dword (devbusfn, PCI_REVISION_ID, &id); pci_read_config_dword (devbusfn, PCI_BASE_ADDRESS_0, &pci_mem_base); pci_read_config_dword (devbusfn, PCI_BASE_ADDRESS_1, &pci_mmio_base); sm501.frameAdrs = pci_mem_to_phys (devbusfn, pci_mem_base); sm501.isaBase = pci_mem_to_phys (devbusfn, pci_mmio_base); if (sm501.isaBase) write_reg32 = write_le32; mem = in_le32 ((unsigned __iomem *)(sm501.isaBase + 0x10)); mem = (mem & 0x0000e000) >> 13; switch (mem) { case 1: mem = 8; break; case 2: mem = 16; break; case 3: mem = 32; break; case 4: mem = 64; break; case 5: mem = 2; break; case 0: default: mem = 4; } printf ("PCI SM50%d %d MB\n", ((id & 0xff) == 0xC0) ? 2 : 1, mem); not_pci: #endif /* * Initialization of the access to the graphic chipset Retreive base * address of the chipset (see board/RPXClassic/eccx.c) */ if (!sm501.isaBase) { sm501.isaBase = board_video_init (); if (!sm501.isaBase) return NULL; } if (!sm501.frameAdrs) { sm501.frameAdrs = board_video_get_fb (); if (!sm501.frameAdrs) return NULL; } sm501.winSizeX = board_get_width (); sm501.winSizeY = board_get_height (); #if defined(CONFIG_VIDEO_SM501_8BPP) sm501.gdfIndex = GDF__8BIT_INDEX; sm501.gdfBytesPP = 1; #elif defined(CONFIG_VIDEO_SM501_16BPP) sm501.gdfIndex = GDF_16BIT_565RGB; sm501.gdfBytesPP = 2; #elif defined(CONFIG_VIDEO_SM501_32BPP) sm501.gdfIndex = GDF_32BIT_X888RGB; sm501.gdfBytesPP = 4; #else #error Unsupported SM501 BPP #endif sm501.memSize = sm501.winSizeX * sm501.winSizeY * sm501.gdfBytesPP; /* Load Smi registers */ SmiSetRegs (); /* (see board/RPXClassic/RPXClassic.c) */ board_validate_screen (sm501.isaBase); /* Clear video memory */ i = sm501.memSize/4; vm = (unsigned int *)sm501.frameAdrs; while(i--) *vm++ = 0; return (&sm501); }