4ab75253616c6d68e967c10221bb663c0bfa99dfmrj

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

f67ca41a3fe371a8ac34045eb45b3c5449ee601crugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/errno.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/types.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/conf.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/kmem.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/visual_io.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/font.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/fbio.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/ddi.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/stat.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/sunddi.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/file.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/open.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/modctl.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/vgareg.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/vgasubr.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/pci.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/kd.h>

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include <sys/ddi_impldefs.h>

60405de4d8688d96dd05157c28db3ade5c9bc234kz

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#include "gfx_private.h"

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define MYNAME "gfxp_vgatext"

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define TEXT_ROWS 25

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define TEXT_COLS 80

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_BRIGHT_WHITE 0x0f

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_BLACK 0x00

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_REG_ADDR 0x3c0

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_REG_SIZE 0x20

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_MEM_ADDR 0xa0000

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_MEM_SIZE 0x20000

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#define VGA_MMAP_FB_BASE VGA_MEM_ADDR

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstruct vgatext_softc {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgaregmap regs;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgaregmap fb;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat off_t fb_size;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int fb_regno;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat dev_info_t *devi;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int mode; /* KD_TEXT or KD_GRAPHICS */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat caddr_t text_base; /* hardware text base */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat char shadow[TEXT_ROWS*TEXT_COLS*2];

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat caddr_t current_base; /* hardware or shadow */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat boolean_t visible;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int row;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int col;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat } cursor;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_polledio polledio;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char red;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char green;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char blue;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat } colormap[VGA8_CMAP_ENTRIES];

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char attrib_palette[VGA_ATR_NUM_PLT];

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat unsigned int flags;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers kmutex_t lock;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat};

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrattypedef enum pc_colors {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_black = 0,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_blue = 1,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_green = 2,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_cyan = 3,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_red = 4,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_magenta = 5,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brown = 6,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_white = 7,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_grey = 8,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_blue = 9,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_green = 10,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_cyan = 11,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_red = 12,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_magenta = 13,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_yellow = 14,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_white = 15

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat} pc_colors_t;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic const unsigned char solaris_color_to_pc_color[16] = {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_white, /* 0 - brt_white */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_black, /* 1 - black */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_blue, /* 2 - blue */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_green, /* 3 - green */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_cyan, /* 4 - cyan */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_red, /* 5 - red */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_magenta, /* 6 - magenta */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brown, /* 7 - brown */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_white, /* 8 - white */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_grey, /* 9 - gery */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_blue, /* 10 - brt_blue */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_green, /* 11 - brt_green */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_cyan, /* 12 - brt_cyan */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_red, /* 13 - brt_red */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_brt_magenta, /* 14 - brt_magenta */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pc_yellow /* 15 - yellow */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat};

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic ddi_device_acc_attr_t dev_attr = {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat DDI_DEVICE_ATTR_V0,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat DDI_NEVERSWAP_ACC,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat DDI_STRICTORDER_ACC,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat};

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic struct fbgattr vgatext_attr = {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat FBTYPE_SUNFAST_COLOR, 0,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat { FBTYPE_SUNFAST_COLOR, TEXT_ROWS, TEXT_COLS, 1, 256, 0 },

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat { 0, FBTYPE_SUN4COLOR, { 0 } },

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat { -1 }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat};

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat#define GFXP_FLAG_CONSOLE 0x00000001

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat#define GFXP_IS_CONSOLE(softc) ((softc)->flags & GFXP_FLAG_CONSOLE)

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

60405de4d8688d96dd05157c28db3ade5c9bc234kzint gfxp_vgatext_detach(dev_info_t *devi, ddi_detach_cmd_t cmd,

60405de4d8688d96dd05157c28db3ade5c9bc234kz gfxp_vgatext_softc_ptr_t ptr);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic int vgatext_devinit(struct vgatext_softc *, struct vis_devinit *data);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_cons_copy(struct vgatext_softc *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_conscopy *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_cons_display(struct vgatext_softc *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_consdisplay *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_cons_cursor(struct vgatext_softc *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_conscursor *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_polled_copy(struct vis_polledio_arg *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_conscopy *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_polled_display(struct vis_polledio_arg *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_consdisplay *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_polled_cursor(struct vis_polledio_arg *,

60405de4d8688d96dd05157c28db3ade5c9bc234kz struct vis_conscursor *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_init(struct vgatext_softc *);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_set_text(struct vgatext_softc *);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void vgatext_save_text(struct vgatext_softc *softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void vgatext_restore_textmode(struct vgatext_softc *softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic int vgatext_suspend(struct vgatext_softc *softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void vgatext_resume(struct vgatext_softc *softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

60405de4d8688d96dd05157c28db3ade5c9bc234kz#if defined(USE_BORDERS)

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_init_graphics(struct vgatext_softc *);

60405de4d8688d96dd05157c28db3ade5c9bc234kz#endif

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic int vgatext_kdsetmode(struct vgatext_softc *softc, int mode);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_setfont(struct vgatext_softc *softc);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_get_cursor(struct vgatext_softc *softc,

60405de4d8688d96dd05157c28db3ade5c9bc234kz screen_pos_t *row, screen_pos_t *col);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_set_cursor(struct vgatext_softc *softc, int row, int col);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_hide_cursor(struct vgatext_softc *softc);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_save_colormap(struct vgatext_softc *softc);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic void vgatext_restore_colormap(struct vgatext_softc *softc);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic int vgatext_get_pci_reg_index(dev_info_t *const devi,

60405de4d8688d96dd05157c28db3ade5c9bc234kz unsigned long himask, unsigned long hival, unsigned long addr,

60405de4d8688d96dd05157c28db3ade5c9bc234kz off_t *offset);

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic int vgatext_get_isa_reg_index(dev_info_t *const devi,

60405de4d8688d96dd05157c28db3ade5c9bc234kz unsigned long hival, unsigned long addr, off_t *offset);

60405de4d8688d96dd05157c28db3ade5c9bc234kz

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic char vgatext_silent;

60405de4d8688d96dd05157c28db3ade5c9bc234kzstatic char happyface_boot;

60405de4d8688d96dd05157c28db3ade5c9bc234kz

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_softc_alloc(void)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (kmem_zalloc(sizeof (struct vgatext_softc), KM_SLEEP));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_softc_free(gfxp_vgatext_softc_ptr_t ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat kmem_free(ptr, sizeof (struct vgatext_softc));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystemsstatic boolean_t

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystemsis_pci_bridge(dev_info_t *dip)

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems{

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems uint32_t class_code;

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems class_code = (uint32_t)ddi_prop_get_int(DDI_DEV_T_ANY, dip,

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems DDI_PROP_DONTPASS, "class-code", 0xffffffff);

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems if (class_code == 0xffffffff || class_code == DDI_PROP_NOT_FOUND)

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems return (B_FALSE);

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems class_code &= 0x00ffff00;

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems if (class_code == ((PCI_CLASS_BRIDGE << 16) | (PCI_BRIDGE_PCI << 8)))

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems return (B_TRUE);

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems return (B_FALSE);

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems}

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat#define STREQ(a, b) (strcmp((a), (b)) == 0)

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugratstatic void

4e93fb0f6383eaac21897dcdae56b87118131e4drugratgfxp_check_for_console(dev_info_t *devi, struct vgatext_softc *softc,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome int pci_pcie_bus)

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat{

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat ddi_acc_handle_t pci_conf;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat dev_info_t *pdevi;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat uint16_t data16;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat /*

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (pci_config_setup(devi, &pci_conf) != DDI_SUCCESS) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf MYNAME

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ": can't get PCI conf handle");

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat return;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat }

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat data16 = pci_config_get16(pci_conf, PCI_CONF_COMM);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (data16 & PCI_COMM_IO)

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat softc->flags |= GFXP_FLAG_CONSOLE;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat pci_config_teardown(&pci_conf);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat /* If IO not enabled or ISA/EISA, just return */

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (!(softc->flags & GFXP_FLAG_CONSOLE) || !pci_pcie_bus)

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat return;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat /*

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems pdevi = devi;

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems while (pdevi = ddi_get_parent(pdevi)) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat int error;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat ddi_acc_handle_t ppci_conf;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat char *parent_type = NULL;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat error = ddi_prop_lookup_string(DDI_DEV_T_ANY, pdevi,

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat DDI_PROP_DONTPASS, "device_type", &parent_type);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (error != DDI_SUCCESS) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat return;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat }

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat /* Verify still on the PCI/PCIEX parent tree */

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (!STREQ(parent_type, "pci") &&

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat !STREQ(parent_type, "pciex")) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat ddi_prop_free(parent_type);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat return;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat }

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat ddi_prop_free(parent_type);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat parent_type = NULL;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems /* VGAEnable is set only for PCI-to-PCI bridges. */

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems if (is_pci_bridge(pdevi) == B_FALSE)

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems continue;

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems if (pci_config_setup(pdevi, &ppci_conf) != DDI_SUCCESS)

93a18d6d401e844455263f926578e9d2aa6b47ecEnrico Perla - Sun Microsystems continue;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat data16 = pci_config_get16(ppci_conf, PCI_BCNF_BCNTRL);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat pci_config_teardown(&ppci_conf);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if (!(data16 & PCI_BCNF_BCNTRL_VGA_ENABLE)) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat softc->flags &= ~GFXP_FLAG_CONSOLE;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat return;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat }

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat }

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat}

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_attach(dev_info_t *devi, ddi_attach_cmd_t cmd,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome gfxp_vgatext_softc_ptr_t ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgatext_softc *softc = (struct vgatext_softc *)ptr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int unit = ddi_get_instance(devi);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int error;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat char *parent_type = NULL;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int reg_rnumber;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat off_t reg_offset;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat off_t mem_offset;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat char *cons;

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat int pci_pcie_bus = 0;

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu int value;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat switch (cmd) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case DDI_ATTACH:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case DDI_RESUME:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_resume(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (DDI_SUCCESS);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat default:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (DDI_FAILURE);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* DDI_ATTACH */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->devi = devi; /* Copy and init DEVI */

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->polledio.arg = (struct vis_polledio_arg *)softc;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->polledio.display = vgatext_polled_display;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->polledio.copy = vgatext_polled_copy;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->polledio.cursor = vgatext_polled_cursor;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers mutex_init(&(softc->lock), NULL, MUTEX_DRIVER, NULL);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat error = ddi_prop_lookup_string(DDI_DEV_T_ANY, ddi_get_parent(devi),

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf DDI_PROP_DONTPASS, "device_type", &parent_type);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (error != DDI_SUCCESS) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN, MYNAME ": can't determine parent type.");

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

60405de4d8688d96dd05157c28db3ade5c9bc234kz /* Not enable AGP and DRM by default */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (STREQ(parent_type, "isa") || STREQ(parent_type, "eisa")) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat reg_rnumber = vgatext_get_isa_reg_index(devi, 1, VGA_REG_ADDR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &reg_offset);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (reg_rnumber < 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf MYNAME

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ": can't find reg entry for registers");

7ae111d47a973fff4c6e231cc31f271dd9cef473ms error = DDI_FAILURE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->fb_regno = vgatext_get_isa_reg_index(devi, 0,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf VGA_MEM_ADDR, &mem_offset);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->fb_regno < 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf MYNAME

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ": can't find reg entry for memory");

7ae111d47a973fff4c6e231cc31f271dd9cef473ms error = DDI_FAILURE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

f40ecdeb280b3d50f8821834c3268ded5874d428rugrat } else if (STREQ(parent_type, "pci") || STREQ(parent_type, "pciex")) {

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat pci_pcie_bus = 1;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat reg_rnumber = vgatext_get_pci_reg_index(devi,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf PCI_REG_ADDR_M|PCI_REG_REL_M,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf PCI_ADDR_IO|PCI_RELOCAT_B, VGA_REG_ADDR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &reg_offset);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (reg_rnumber < 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf MYNAME

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ": can't find reg entry for registers");

7ae111d47a973fff4c6e231cc31f271dd9cef473ms error = DDI_FAILURE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->fb_regno = vgatext_get_pci_reg_index(devi,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf PCI_REG_ADDR_M|PCI_REG_REL_M,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf PCI_ADDR_MEM32|PCI_RELOCAT_B, VGA_MEM_ADDR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &mem_offset);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->fb_regno < 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf MYNAME

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ": can't find reg entry for memory");

7ae111d47a973fff4c6e231cc31f271dd9cef473ms error = DDI_FAILURE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat } else {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN, MYNAME ": unknown parent type \"%s\".",

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf parent_type);

7ae111d47a973fff4c6e231cc31f271dd9cef473ms error = DDI_FAILURE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ddi_prop_free(parent_type);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat parent_type = NULL;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat error = ddi_regs_map_setup(devi, reg_rnumber,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf (caddr_t *)&softc->regs.addr, reg_offset, VGA_REG_SIZE,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &dev_attr, &softc->regs.handle);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (error != DDI_SUCCESS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->regs.mapped = B_TRUE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->fb_size = VGA_MEM_SIZE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat error = ddi_regs_map_setup(devi, softc->fb_regno,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf (caddr_t *)&softc->fb.addr,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf mem_offset, softc->fb_size,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &dev_attr, &softc->fb.handle);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (error != DDI_SUCCESS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat goto fail;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->fb.mapped = B_TRUE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

4ab75253616c6d68e967c10221bb663c0bfa99dfmrj if (ddi_get8(softc->regs.handle,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->regs.addr + VGA_MISC_R) & VGA_MISC_IOA_SEL)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->text_base = (caddr_t)softc->fb.addr + VGA_COLOR_BASE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat else

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->text_base = (caddr_t)softc->fb.addr + VGA_MONO_BASE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ddi_prop_lookup_string(DDI_DEV_T_ANY, ddi_root_node(),

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf DDI_PROP_DONTPASS, "console", &cons) == DDI_SUCCESS) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (strcmp(cons, "graphics") == 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat happyface_boot = 1;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_silent = 1;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->current_base = softc->shadow;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers } else {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->current_base = softc->text_base;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ddi_prop_free(cons);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers } else {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->current_base = softc->text_base;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers error = ddi_prop_create(makedevice(DDI_MAJOR_T_UNKNOWN, unit),

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers devi, DDI_PROP_CANSLEEP, DDI_KERNEL_IOCTL, NULL, 0);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers if (error != DDI_SUCCESS)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers goto fail;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat gfxp_check_for_console(devi, softc, pci_pcie_bus);

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu value = GFXP_IS_CONSOLE(softc) ? 1 : 0;

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu if (ddi_prop_update_int(DDI_DEV_T_NONE, devi,

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu "primary-controller", value) != DDI_SUCCESS) {

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu cmn_err(CE_WARN,

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu "Can not %s primary-controller "

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu "property for driver", value ? "set" : "clear");

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu }

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* only do this if not in graphics mode */

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if ((vgatext_silent == 0) && (GFXP_IS_CONSOLE(softc))) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_init(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_save_colormap(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (DDI_SUCCESS);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratfail:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (parent_type != NULL)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ddi_prop_free(parent_type);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat (void) gfxp_vgatext_detach(devi, DDI_DETACH, (void *)softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (error);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_detach(dev_info_t *devi, ddi_detach_cmd_t cmd,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome gfxp_vgatext_softc_ptr_t ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgatext_softc *softc = (struct vgatext_softc *)ptr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu (void) ddi_prop_remove(DDI_DEV_T_ANY, devi, "primary-controller");

f4ce81cfdad23bacfdb147be77d8d5fbe7673847Edward Shu

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat switch (cmd) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf case DDI_SUSPEND:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (vgatext_suspend(softc));

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf /* break; */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case DDI_DETACH:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->fb.mapped)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ddi_regs_map_free(&softc->fb.handle);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->regs.mapped)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ddi_regs_map_free(&softc->regs.handle);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers mutex_destroy(&(softc->lock));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (DDI_SUCCESS);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat default:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN, "gfxp_vgatext_detach: unknown cmd 0x%x\n",

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf cmd);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (DDI_FAILURE);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_open(dev_t *devp, int flag, int otyp, cred_t *cred,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome gfxp_vgatext_softc_ptr_t ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgatext_softc *softc = (struct vgatext_softc *)ptr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc == NULL || otyp == OTYP_BLK)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (ENXIO);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_close(dev_t devp, int flag, int otyp, cred_t *cred,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome gfxp_vgatext_softc_ptr_t ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersstatic int

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersdo_gfx_ioctl(int cmd, intptr_t data, int mode, struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat static char kernel_only[] =

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf "gfxp_vgatext_ioctl: %s is a kernel only ioctl";

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int err;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int kd_mode;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat switch (cmd) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case KDSETMODE:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (vgatext_kdsetmode(softc, (int)data));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case KDGETMODE:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat kd_mode = softc->mode;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ddi_copyout(&kd_mode, (void *)data, sizeof (int), mode))

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_DEVINIT:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (!(mode & FKIOCTL)) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf cmn_err(CE_CONT, kernel_only, "VIS_DEVINIT");

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (ENXIO);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf err = vgatext_devinit(softc, (struct vis_devinit *)data);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (err != 0) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf cmn_err(CE_WARN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf "gfxp_vgatext_ioctl: could not"

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf " initialize console");

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (err);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_CONSCOPY: /* move */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf struct vis_conscopy pma;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (ddi_copyin((void *)data, &pma,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf sizeof (struct vis_conscopy), mode))

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_cons_copy(softc, &pma);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_CONSDISPLAY: /* display */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf struct vis_consdisplay display_request;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (ddi_copyin((void *)data, &display_request,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf sizeof (display_request), mode))

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_cons_display(softc, &display_request);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_CONSCURSOR:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf struct vis_conscursor cursor_request;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (ddi_copyin((void *)data, &cursor_request,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf sizeof (cursor_request), mode))

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_cons_cursor(softc, &cursor_request);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (cursor_request.action == VIS_GET_CURSOR &&

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ddi_copyout(&cursor_request, (void *)data,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf sizeof (cursor_request), mode))

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (EFAULT);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_GETCMAP:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_PUTCMAP:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case FBIOPUTCMAP:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case FBIOGETCMAP:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (EINVAL);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case FBIOGATTR:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (copyout(&vgatext_attr, (void *)data,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat sizeof (struct fbgattr)))

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case FBIOGTYPE:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (copyout(&vgatext_attr.fbtype, (void *)data,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat sizeof (struct fbtype)))

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (EFAULT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat default:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (ENXIO);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersgfxp_vgatext_ioctl(

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers dev_t dev,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers int cmd,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers intptr_t data,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers int mode,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers cred_t *cred,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers int *rval,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers gfxp_vgatext_softc_ptr_t ptr)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers{

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers int err;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers struct vgatext_softc *softc = (struct vgatext_softc *)ptr;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers mutex_enter(&(softc->lock));

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers err = do_gfx_ioctl(cmd, data, mode, softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers mutex_exit(&(softc->lock));

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers return (err);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers}

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfvgatext_save_text(struct vgatext_softc *softc)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf{

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf unsigned i;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf for (i = 0; i < sizeof (softc->shadow); i++)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->shadow[i] = softc->current_base[i];

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf}

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfvgatext_restore_textmode(struct vgatext_softc *softc)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf{

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf unsigned i;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_init(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf for (i = 0; i < sizeof (softc->shadow); i++) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->text_base[i] = softc->shadow[i];

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if (softc->cursor.visible) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_set_cursor(softc,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->cursor.row, softc->cursor.col);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_restore_colormap(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf}

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic int

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfvgatext_suspend(struct vgatext_softc *softc)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf{

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf switch (softc->mode) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf case KD_TEXT:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_save_text(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf case KD_GRAPHICS:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf default:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf cmn_err(CE_WARN, MYNAME ": unknown mode in vgatext_suspend.");

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (DDI_FAILURE);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf return (DDI_SUCCESS);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf}

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfstatic void

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyfvgatext_resume(struct vgatext_softc *softc)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf{

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf switch (softc->mode) {

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf case KD_TEXT:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_restore_textmode(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf case KD_GRAPHICS:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf /*

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_restore_textmode(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf#if defined(USE_BORDERS)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vgatext_init_graphics(softc);

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf#endif

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf default:

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf cmn_err(CE_WARN, MYNAME ": unknown mode in vgatext_resume.");

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf }

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf}

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersstatic void

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersvgatext_progressbar_stop()

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers{

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers extern void progressbar_stop(void);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers if (vgatext_silent == 1) {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_silent = 0;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers progressbar_stop();

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers }

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers}

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersstatic void

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersvgatext_kdsettext(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_init(softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers for (i = 0; i < sizeof (softc->shadow); i++) {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->text_base[i] = softc->shadow[i];

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers }

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->current_base = softc->text_base;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers if (softc->cursor.visible) {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_set_cursor(softc,

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->cursor.row, softc->cursor.col);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers }

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_restore_colormap(softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers}

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersstatic void

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersvgatext_kdsetgraphics(struct vgatext_softc *softc)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers{

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_progressbar_stop();

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_save_text(softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers softc->current_base = softc->shadow;

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers#if defined(USE_BORDERS)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_init_graphics(softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers#endif

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers}

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersstatic int

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilersvgatext_kdsetmode(struct vgatext_softc *softc, int mode)

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers{

4e93fb0f6383eaac21897dcdae56b87118131e4drugrat if ((mode == softc->mode) || (!GFXP_IS_CONSOLE(softc)))

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat switch (mode) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case KD_TEXT:

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_kdsettext(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case KD_GRAPHICS:

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_kdsetgraphics(softc);

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers break;

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers case KD_RESETTEXT:

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers /*

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers if (softc->mode == KD_TEXT && vgatext_silent == 1) {

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_progressbar_stop();

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers vgatext_kdsettext(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat default:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (EINVAL);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

48633f182599946aebd63dccdc852ad722b57d0eJan Setje-Eilers

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->mode = mode;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratgfxp_vgatext_devmap(dev_t dev, devmap_cookie_t dhp, offset_t off, size_t len,

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome size_t *maplen, uint_t model, void *ptr)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vgatext_softc *softc = (struct vgatext_softc *)ptr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int err;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat size_t length;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc == NULL) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN, "vgatext: Can't find softstate");

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (-1);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (!(off >= VGA_MMAP_FB_BASE &&

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf off < VGA_MMAP_FB_BASE + softc->fb_size)) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cmn_err(CE_WARN, "vgatext: Can't map offset 0x%llx", off);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (-1);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (off + len > VGA_MMAP_FB_BASE + softc->fb_size)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat length = VGA_MMAP_FB_BASE + softc->fb_size - off;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat else

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat length = len;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf if ((err = devmap_devmem_setup(dhp, softc->devi,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf NULL, softc->fb_regno, off - VGA_MMAP_FB_BASE,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf length, PROT_ALL, 0, &dev_attr)) < 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (err);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat *maplen = length;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic int

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_devinit(struct vgatext_softc *softc, struct vis_devinit *data)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* initialize console instance */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->version = VIS_CONS_REV;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->width = TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->height = TEXT_ROWS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->linebytes = TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->depth = 4;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->mode = VIS_TEXT;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat data->polledio = &softc->polledio;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_cons_display(struct vgatext_softc *softc, struct vis_consdisplay *da)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char *string;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char attr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct cgatext {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char ch;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char attr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat };

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct cgatext *addr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (da->row < 0 || da->row >= TEXT_ROWS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat da->col < 0 || da->col >= TEXT_COLS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat da->col + da->width > TEXT_COLS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat attr = (solaris_color_to_pc_color[da->bg_color & 0xf] << 4)

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf | solaris_color_to_pc_color[da->fg_color & 0xf];

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat string = da->data;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr = (struct cgatext *)softc->current_base

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf + (da->row * TEXT_COLS + da->col);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < da->width; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr->ch = string[i];

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr->attr = attr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr++;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_polled_display(

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_polledio_arg *arg,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_consdisplay *da)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_cons_display((struct vgatext_softc *)arg, da);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_cons_copy(struct vgatext_softc *softc, struct vis_conscopy *ma)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned short *from;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned short *to;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int cnt;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat screen_size_t chars_per_row;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned short *to_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned short *from_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat screen_size_t rows_to_move;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned short *base;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ma->s_col < 0 || ma->s_col >= TEXT_COLS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->s_row < 0 || ma->s_row >= TEXT_ROWS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->e_col < 0 || ma->e_col >= TEXT_COLS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->e_row < 0 || ma->e_row >= TEXT_ROWS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->t_col < 0 || ma->t_col >= TEXT_COLS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->t_row < 0 || ma->t_row >= TEXT_ROWS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->s_col > ma->e_col ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->s_row > ma->e_row)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat chars_per_row = ma->e_col - ma->s_col + 1;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat rows_to_move = ma->e_row - ma->s_row + 1;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* More sanity checks. */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ma->t_row + rows_to_move > TEXT_ROWS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ma->t_col + chars_per_row > TEXT_COLS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat base = (unsigned short *)softc->current_base;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to_row_start = base + ((ma->t_row * TEXT_COLS) + ma->t_col);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from_row_start = base + ((ma->s_row * TEXT_COLS) + ma->s_col);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (to_row_start < from_row_start) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat while (rows_to_move-- > 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to = to_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from = from_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to_row_start += TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from_row_start += TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (cnt = chars_per_row; cnt-- > 0; )

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat *to++ = *from++;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat } else {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat cnt = rows_to_move * TEXT_COLS + chars_per_row;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to_row_start += cnt;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from_row_start += cnt;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat while (rows_to_move-- > 0) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to_row_start -= TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from_row_start -= TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to = to_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat from = from_row_start;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (cnt = chars_per_row; cnt-- > 0; )

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat *--to = *--from;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_polled_copy(

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_polledio_arg *arg,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_conscopy *ca)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_cons_copy((struct vgatext_softc *)arg, ca);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_cons_cursor(struct vgatext_softc *softc, struct vis_conscursor *ca)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (vgatext_silent)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat switch (ca->action) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_HIDE_CURSOR:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->cursor.visible = B_FALSE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->current_base == softc->text_base)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_hide_cursor(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_DISPLAY_CURSOR:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ca->col < 0 || ca->col >= TEXT_COLS ||

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat ca->row < 0 || ca->row >= TEXT_ROWS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->cursor.visible = B_TRUE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->cursor.col = ca->col;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->cursor.row = ca->row;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->current_base == softc->text_base)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_set_cursor(softc, ca->row, ca->col);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat case VIS_GET_CURSOR:

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (softc->current_base == softc->text_base) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_get_cursor(softc, &ca->row, &ca->col);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat break;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_polled_cursor(

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_polledio_arg *arg,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat struct vis_conscursor *ca)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_cons_cursor((struct vgatext_softc *)arg, ca);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_hide_cursor(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* Nothing at present */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_set_cursor(struct vgatext_softc *softc, int row, int col)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat short addr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (vgatext_silent)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr = row * TEXT_COLS + col;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_crtc(&softc->regs, VGA_CRTC_CLAH, addr >> 8);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_crtc(&softc->regs, VGA_CRTC_CLAL, addr & 0xff);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic int vga_row, vga_col;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_get_cursor(struct vgatext_softc *softc,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat screen_pos_t *row, screen_pos_t *col)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat short addr;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat addr = (vga_get_crtc(&softc->regs, VGA_CRTC_CLAH) << 8) +

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_get_crtc(&softc->regs, VGA_CRTC_CLAL);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_row = *row = addr / TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_col = *col = addr % TEXT_COLS;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_set_text(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (happyface_boot == 0)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* we are in graphics mode, set to text 80X25 mode */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set misc registers */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_reg(&softc->regs, VGA_MISC_W, VGA_MISC_TEXT);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set sequencer registers */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, VGA_SEQ_RST_SYN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf (vga_get_seq(&softc->regs, VGA_SEQ_RST_SYN) &

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ~VGA_SEQ_RST_SYN_NO_SYNC_RESET));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 1; i < NUM_SEQ_REG; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, i, VGA_SEQ_TEXT[i]);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, VGA_SEQ_RST_SYN,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf (vga_get_seq(&softc->regs, VGA_SEQ_RST_SYN) |

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf VGA_SEQ_RST_SYN_NO_ASYNC_RESET |

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf VGA_SEQ_RST_SYN_NO_SYNC_RESET));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set crt controller registers */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_crtc(&softc->regs, VGA_CRTC_VRE,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf (vga_get_crtc(&softc->regs, VGA_CRTC_VRE) &

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf ~VGA_CRTC_VRE_LOCK));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < NUM_CRTC_REG; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_crtc(&softc->regs, i, VGA_CRTC_TEXT[i]);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set graphics controller registers */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < NUM_GRC_REG; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, i, VGA_GRC_TEXT[i]);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set attribute registers */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < NUM_ATR_REG; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, i, VGA_ATR_TEXT[i]);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /* set palette */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < VGA_TEXT_CMAP_ENTRIES; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_put_cmap(&softc->regs, i, VGA_TEXT_PALETTES[i][0] << 2,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf VGA_TEXT_PALETTES[i][1] << 2,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf VGA_TEXT_PALETTES[i][2] << 2);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = VGA_TEXT_CMAP_ENTRIES; i < VGA8_CMAP_ENTRIES; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_put_cmap(&softc->regs, i, 0, 0, 0);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_save_colormap(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_init(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char atr_mode;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat atr_mode = vga_get_atr(&softc->regs, VGA_ATR_MODE);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (atr_mode & VGA_ATR_MODE_GRAPH)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_set_text(softc);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat atr_mode = vga_get_atr(&softc->regs, VGA_ATR_MODE);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat atr_mode &= ~VGA_ATR_MODE_BLINK;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat atr_mode &= ~VGA_ATR_MODE_9WIDE;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, VGA_ATR_MODE, atr_mode);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#if defined(USE_BORDERS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, VGA_ATR_BDR_CLR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vga_get_atr(&softc->regs, VGA_BRIGHT_WHITE));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#else

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, VGA_ATR_BDR_CLR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vga_get_atr(&softc->regs, VGA_BLACK));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#endif

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vgatext_setfont(softc); /* need selectable font? */

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#if defined(USE_BORDERS)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_init_graphics(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, VGA_ATR_BDR_CLR,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf vga_get_atr(&softc->regs, VGA_BLACK));

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat#endif

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_setfont(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome extern bitmap_data_t font_data_8x16;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char *from;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned char *to;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int j;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int bpc;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, 0x02, 0x04);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, 0x04, 0x06);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, 0x05, 0x00);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, 0x06, 0x04);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat /*

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat bpc = 16;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < 256; i++) {

d1e631af56641f21cde1f1efe3a9623ff9d6ee7cToomas Soome from = font_data_8x16.encoding[i];

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat to = (unsigned char *)softc->fb.addr + i * 0x20;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (j = 0; j < bpc; j++)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat *to++ = *from++;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, 0x02, 0x03);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_seq(&softc->regs, 0x04, 0x02);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, 0x04, 0x00);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, 0x05, 0x10);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_grc(&softc->regs, 0x06, 0x0e);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_save_colormap(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < VGA_ATR_NUM_PLT; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat softc->attrib_palette[i] = vga_get_atr(&softc->regs, i);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < VGA8_CMAP_ENTRIES; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_get_cmap(&softc->regs, i,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &softc->colormap[i].red,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &softc->colormap[i].green,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf &softc->colormap[i].blue);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic void

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_restore_colormap(struct vgatext_softc *softc)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int i;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < VGA_ATR_NUM_PLT; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_set_atr(&softc->regs, i, softc->attrib_palette[i]);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat for (i = 0; i < VGA8_CMAP_ENTRIES; i++) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat vga_put_cmap(&softc->regs, i,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->colormap[i].red,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->colormap[i].green,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf softc->colormap[i].blue);

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat }

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat}

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratstatic int

fc1821fee2e1f208a4b5ff3e229e97b87979208arugratvgatext_get_pci_reg_index(

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat dev_info_t *const devi,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned long himask,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned long hival,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat unsigned long addr,

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat off_t *offset)

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat{

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat int length, index;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat pci_regspec_t *reg;

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat if (ddi_getlongprop(DDI_DEV_T_ANY, devi, DDI_PROP_DONTPASS,

2df1fe9ca32bb227b9158c67f5c00b54c20b10fdrandyf "reg", (caddr_t)&reg, &length) != DDI_PROP_SUCCESS) {

fc1821fee2e1f208a4b5ff3e229e97b87979208arugrat return (-1);