/*
* Copyright (c) 2006, 2015, Oracle and/or its affiliates. All rights reserved.
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the "Software"),
* to deal in the Software without restriction, including without limitation
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
* and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice (including the next
* paragraph) shall be included in all copies or substantial portions of the
* Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
* DEALINGS IN THE SOFTWARE.
*/
#include "libvtsSUNWast.h"
hrtime_t ast_loop_time = (hrtime_t)10 * NANOSEC; /* time to busy wait */
int
ast_map_mem(
register return_packet *const rp,
register int const test)
{
register int const pagesize = getpagesize();
if (ast_get_pci_info() != 0) {
gfx_vts_set_message(rp, 1, test, "get pci info failed");
return (-1);
}
ast_info.ast_fb_size = (ast_info.ast_fb_size + pagesize - 1) /
pagesize * pagesize;
/*
* Map framebuffer
*/
if (ast_map_fb() != 0) {
gfx_vts_set_message(rp, 1, test, "map framebuffer failed");
return (-1);
}
ast_info.ast_mmio_size = (ast_info.ast_mmio_size + pagesize - 1) /
pagesize * pagesize;
/*
* Map MMIO
*/
if (ast_map_mmio() != 0) {
gfx_vts_set_message(rp, 1, test, "map MMIO failed");
return (-1);
}
return (0);
}
int
ast_get_pci_info(
void)
{
struct gfx_pci_cfg pciconfig;
int i;
uint_t bar;
uint_t bar_hi;
offset_t mem_base[6];
offset_t io_base[6];
int type[6];
uchar_t pots;
if (ioctl(ast_info.ast_fd, GFX_IOCTL_GET_PCI_CONFIG,
&pciconfig) != 0) {
return (-1);
}
ast_info.ast_vendor = pciconfig.VendorID;
ast_info.ast_device = pciconfig.DeviceID;
for (i = 0; i < 6; i++) {
type[i] = 0;
mem_base[i] = 0;
io_base[i] = 0;
}
for (i = 0; i < 6; i++) {
bar = pciconfig.bar[i];
if (bar != 0) {
if (bar & PCI_MAP_IO) {
io_base[i] = PCIGETIO(bar);
type[i] = bar & PCI_MAP_IO_ATTR_MASK;
} else {
type[i] = bar & PCI_MAP_MEMORY_ATTR_MASK;
mem_base[i] = PCIGETMEMORY(bar);
if (PCI_MAP_IS64BITMEM(bar)) {
if (i == 5) {
mem_base[i] = 0;
} else {
bar_hi = pciconfig.bar[i+1];
mem_base[i] |=
((offset_t)bar_hi << 32);
++i;
}
}
}
}
}
ast_info.ast_fb_addr = mem_base[0] & 0xfff00000;
ast_info.ast_fb_size = 0;
ast_info.ast_mmio_addr = mem_base[1] & 0xffff0000;
ast_info.ast_mmio_size = AST_MMIO_SIZE;
ast_info.ast_relocate_io = io_base[2];
if (ast_open_key() != 0)
return (-1);
if (ast_get_index_reg(&pots, CRTC_PORT, 0xAA) != 0)
return (-1);
switch (pots & 0x03) {
case 0x00:
ast_info.ast_fb_size = AST_VRAM_SIZE_08M;
break;
case 0x01:
ast_info.ast_fb_size = AST_VRAM_SIZE_16M;
break;
case 0x02:
ast_info.ast_fb_size = AST_VRAM_SIZE_32M;
break;
case 0x03:
ast_info.ast_fb_size = AST_VRAM_SIZE_64M;
break;
}
if (gfx_vts_debug_mask & VTS_DEBUG) {
printf("ast_vendor = 0x%04x, ast_device = 0x%04x\n",
ast_info.ast_vendor, ast_info.ast_device);
printf("ast_fb_addr 0x%llx, ast_fb_size 0x%lx\n",
(unsigned long long)ast_info.ast_fb_addr,
(unsigned long)ast_info.ast_fb_size);
printf("ast_mmio_addr 0x%llx, ast_mmio_size 0x%lx\n",
(unsigned long long)ast_info.ast_mmio_addr,
(unsigned long)ast_info.ast_mmio_size);
printf("ast_relocate_io 0x%llx\n",
(unsigned long long)ast_info.ast_relocate_io);
}
return (0);
}
int
ast_map_mmio(
void)
{
if (ast_info.ast_mmio_ptr == NULL) {
register void *ptr;
ptr = mmap(NULL, ast_info.ast_mmio_size,
PROT_READ | PROT_WRITE, MAP_SHARED,
ast_info.ast_fd, ast_info.ast_mmio_addr);
if (ptr == MAP_FAILED)
return (-1);
ast_info.ast_mmio_ptr = (uchar_t *)ptr;
}
if (gfx_vts_debug_mask & VTS_DEBUG)
printf("ast_mmio_ptr = 0x%llx\n",
(unsigned long long)ast_info.ast_mmio_ptr);
return (0);
}
int
ast_map_fb(
void)
{
if (ast_info.ast_fb_ptr == NULL) {
register void *ptr;
ptr = mmap(NULL, ast_info.ast_fb_size,
PROT_READ | PROT_WRITE, MAP_SHARED,
ast_info.ast_fd, ast_info.ast_fb_addr);
if (ptr == MAP_FAILED)
return (-1);
ast_info.ast_fb_ptr = (uchar_t *)ptr;
}
if (gfx_vts_debug_mask & VTS_DEBUG)
printf("ast_fb_ptr = 0x%llx\n",
(unsigned long long)ast_info.ast_fb_ptr);
return (0);
}
int
ast_init_info(
register return_packet *const rp,
register int const test)
{
register uint_t mode;
register uint_t width;
register uint_t height;
register uint_t depth;
register uint_t pixelsize;
register uint_t offset;
register uint_t memsize;
uchar_t save_gctl;
uchar_t misc;
uchar_t hde;
uchar_t ovf;
uchar_t vde;
uchar_t off;
uchar_t undloc;
uchar_t modectl;
uchar_t pcicr3;
uchar_t ecm;
uchar_t xhovf;
uchar_t xvovf;
uchar_t offovf;
unsigned int status = 0;
/*
* first check if the hardware is already initialized.
* If not, abort
*/
if (ioctl(ast_info.ast_fd, AST_GET_STATUS_FLAGS, &status) != 0) {
gfx_vts_set_message(rp, 1, test,
"AST_GET_STATUS_FLAGS failed");
return (-1);
}
if (!(status & AST_STATUS_HW_INITIALIZED)) {
gfx_vts_set_message(rp, 1, test,
"AST_GET_STATUS_FLAGS not initialized");
return (-1);
}
if (ast_open_key() != 0) {
gfx_vts_set_message(rp, 1, test, "unable to open key");
return (-1);
}
if (ast_get_reg(&save_gctl, GR_PORT) != 0) {
gfx_vts_set_message(rp, 1, test,
"unable to get the gctl index");
return (-1);
}
if (ast_get_index_reg(&misc, GR_PORT, 0x06) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the misc");
return (-1);
}
if (ast_set_reg(GR_PORT, save_gctl) != 0) {
gfx_vts_set_message(rp, 1, test,
"unable to set the gctl index");
return (-1);
}
if (ast_get_index_reg(&hde, CRTC_PORT, 0x01) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the hde");
return (-1);
}
if (ast_get_index_reg(&ovf, CRTC_PORT, 0x07) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the ovf");
return (-1);
}
if (ast_get_index_reg(&vde, CRTC_PORT, 0x12) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the vde");
return (-1);
}
if (ast_get_index_reg(&off, CRTC_PORT, 0x13) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the offset");
return (-1);
}
if (ast_get_index_reg(&undloc, CRTC_PORT, 0x14) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the undloc");
return (-1);
}
if (ast_get_index_reg(&modectl, CRTC_PORT, 0x17) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the modectl");
return (-1);
}
if (ast_get_index_reg(&pcicr3, CRTC_PORT, 0xa2) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the pcicr3");
return (-1);
}
if (ast_get_index_reg(&ecm, CRTC_PORT, 0xa3) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the ecm");
return (-1);
}
if (ast_get_index_reg(&xhovf, CRTC_PORT, 0xac) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the xhovf");
return (-1);
}
if (ast_get_index_reg(&xvovf, CRTC_PORT, 0xae) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the xvovf");
return (-1);
}
if (ast_get_index_reg(&offovf, CRTC_PORT, 0xb0) != 0) {
gfx_vts_set_message(rp, 1, test, "unable to get the offovf");
return (-1);
}
width = (((((uint_t)xhovf & 0x4) >> 2 << 8) |
(uint_t)hde) + 1) << 3;
height = ((((uint_t)xvovf & 0x2) >> 1 << 10) |
(((uint_t)ovf & 0x40) >> 6 << 9) |
(((uint_t)ovf & 0x02) >> 1 << 8) |
(uint_t)vde) + 1;
offset = (((uint_t)offovf & 0x3f) << 8) | (uint_t)off;
memsize = (undloc & 0x40) ? 4 :
((modectl & 0x40) ? 1 : 2);
if (!(misc & 0x01)) {
if (!(ecm & 0x01)) {
mode = VIS_TEXT;
depth = 4;
width /= 8;
height /= 16;
pixelsize = 2;
} else {
mode = VIS_PIXEL;
depth = 8;
pixelsize = 1;
}
} else {
mode = VIS_PIXEL;
switch (ecm & 0xf) {
case 0x01:
/* enable enhanced 256 color display mode */
depth = 8;
pixelsize = 1;
break;
case 0x02:
/* enable 15-bpp high color display mode (rgb:555) */
depth = 15;
pixelsize = 2;
break;
case 0x04:
/* enable 16-bpp high color display mode (rgb:565) */
depth = 16;
pixelsize = 2;
break;
case 0x08:
/* enable 32-bpp true color display mode (argb:8888) */
depth = 32;
pixelsize = 4;
break;
default:
gfx_vts_set_message(rp, 1, test, "invalid ecm");
return (-1);
}
}
ast_info.ast_mode = mode;
ast_info.ast_width = width;
ast_info.ast_height = height;
ast_info.ast_depth = depth;
ast_info.ast_pixelsize = pixelsize;
ast_info.ast_linesize = offset * memsize * 2;
switch (pcicr3 & 0xc0) {
case 0x00: /* little endian */
case 0x40:
ast_info.ast_endian = 0;
break;
case 0x80: /* big endian 32 */
ast_info.ast_endian = 2;
break;
case 0xc0: /* big endian 16 */
ast_info.ast_endian = 1;
break;
}
if (gfx_vts_debug_mask & VTS_DEBUG) {
printf("width=%d height=%d depth=%d pitch=%d\n",
ast_info.ast_width, ast_info.ast_height,
ast_info.ast_depth, ast_info.ast_linesize);
}
return (0);
}
int
ast_init_graphics(
void)
{
unsigned int ulData;
register int status = 0;
/*
* Enable MMIO
*/
if (ast_get_index_reg(&ast_info.ast_pcicr2, CRTC_PORT, 0xA1) != 0)
return (-1);
if (ast_set_index_reg(CRTC_PORT, 0xA1, 0x4) != 0)
return (-1);
ast_info.ast_remap_base = ast_mmio_read32(0xF004);
ast_info.ast_prot_key = ast_mmio_read32(0xF000);
if (ast_get_index_reg(&ast_info.ast_misc_control, CRTC_PORT, 0xA4) != 0)
return (-1);
ast_mmio_write32(0xF004, 0x1e6e0000);
ast_mmio_write32(0xF000, 0x1);
ulData = ast_mmio_read32(0x1200c);
ast_mmio_write32(0x1200c, ulData & 0xFFFFFFFD);
if (!(ast_info.ast_misc_control & 0x01)) {
if (ast_set_index_reg(CRTC_PORT, 0xA4,
ast_info.ast_misc_control | 0x01) != 0)
return (-1);
status = 1;
}
if (!ast_wait_idle())
return (-1);
ast_info.ast_queue = ast_mmio_read32(MMIOREG_QUEUE);
ast_info.ast_dst_base = ast_mmio_read32(MMIOREG_DST_BASE);
ast_info.ast_dst_pitch = ast_mmio_read32(MMIOREG_DST_PITCH);
ast_info.ast_dst_xy = ast_mmio_read32(MMIOREG_DST_XY);
ast_info.ast_line_err = ast_mmio_read32(MMIOREG_LINE_ERR);
ast_info.ast_rect_xy = ast_mmio_read32(MMIOREG_RECT_XY);
ast_info.ast_fg = ast_mmio_read32(MMIOREG_FG);
ast_info.ast_bg = ast_mmio_read32(MMIOREG_BG);
ast_info.ast_mono1 = ast_mmio_read32(MMIOREG_MONO1);
ast_info.ast_mono2 = ast_mmio_read32(MMIOREG_MONO2);
ast_info.ast_clip1 = ast_mmio_read32(MMIOREG_CLIP1);
ast_info.ast_clip2 = ast_mmio_read32(MMIOREG_CLIP2);
if (!(ast_info.ast_queue & QUEUE_MEMORY_MAP)) {
ast_mmio_write32(MMIOREG_QUEUE,
ast_info.ast_queue | QUEUE_MEMORY_MAP);
status = 1;
}
if (!ast_store_mmio(MMIOREG_CLIP1,
((0 & MASK_CLIP) << 16) |
(0 & MASK_CLIP)))
return (-1);
if (!ast_store_mmio(MMIOREG_CLIP2,
((ast_info.ast_width & MASK_CLIP) << 16) |
(ast_info.ast_height & MASK_CLIP)))
return (-1);
return (status);
}
int
ast_finish_graphics(
void)
{
register int status = 0;
ast_store_mmio(MMIOREG_DST_BASE, ast_info.ast_dst_base);
ast_store_mmio(MMIOREG_DST_PITCH, ast_info.ast_dst_pitch);
ast_store_mmio(MMIOREG_DST_XY, ast_info.ast_dst_xy);
ast_store_mmio(MMIOREG_LINE_ERR, ast_info.ast_line_err);
ast_store_mmio(MMIOREG_RECT_XY, ast_info.ast_rect_xy);
ast_store_mmio(MMIOREG_FG, ast_info.ast_fg);
ast_store_mmio(MMIOREG_BG, ast_info.ast_bg);
ast_store_mmio(MMIOREG_MONO1, ast_info.ast_mono1);
ast_store_mmio(MMIOREG_MONO2, ast_info.ast_mono2);
ast_store_mmio(MMIOREG_CLIP1, ast_info.ast_clip1);
ast_store_mmio(MMIOREG_CLIP2, ast_info.ast_clip2);
ast_store_mmio(MMIOREG_QUEUE, ast_info.ast_queue);
if (!(ast_info.ast_misc_control & 0x01)) {
if (ast_set_index_reg(CRTC_PORT,
0xA4, ast_info.ast_misc_control) != 0)
status = -1;
else
status = 1;
}
ast_mmio_write32(0xF004, ast_info.ast_remap_base);
ast_mmio_write32(0xF000, ast_info.ast_prot_key);
if (ast_set_index_reg(CRTC_PORT, 0xA1, ast_info.ast_pcicr2) != 0)
status = -1;
return (status);
}
int
ast_save_palet(
void)
{
register uint_t coloron;
register int status = 1;
uchar_t junk;
for (coloron = 0; coloron < 256; coloron++) {
if (ast_set_reg(DAC_INDEX_READ, coloron) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_get_reg(&ast_info.ast_red[coloron], DAC_DATA) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_get_reg(&ast_info.ast_green[coloron], DAC_DATA) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_get_reg(&ast_info.ast_blue[coloron], DAC_DATA) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
}
return (status);
}
int
ast_set_palet(
void)
{
register uint_t coloron;
register int status = 1;
register uint_t maxdac;
uchar_t ramdac_ctrl;
uchar_t new_red[256];
uchar_t new_green[256];
uchar_t new_blue[256];
uchar_t junk;
if (ast_get_index_reg(&ramdac_ctrl, CRTC_PORT, 0xA8) != 0)
return (-1);
maxdac = (ramdac_ctrl & 0x2) ? 255 : 63;
switch (ast_info.ast_depth) {
case 8: /* 3, 3, 2 */
for (coloron = 0; coloron < 256; coloron++) {
new_red[coloron] =
(uint8_t)(((coloron >> 5) & 0x7) * maxdac / 7);
new_green[coloron] =
(uint8_t)(((coloron >> 2) & 0x7) * maxdac / 7);
new_blue[coloron] =
(uint8_t)((coloron & 0x3) * maxdac / 3);
}
break;
case 15: /* 5, 5, 5 */
for (coloron = 0; coloron < 256; coloron++) {
new_red[coloron] =
(uint8_t)((coloron / 8) * maxdac / 31);
new_green[coloron] =
(uint8_t)((coloron / 8) * maxdac / 31);
new_blue[coloron] =
(uint8_t)((coloron / 8) * maxdac / 31);
}
break;
case 16: /* 5, 6, 5 */
for (coloron = 0; coloron < 256; coloron++) {
new_red[coloron] =
(uint8_t)((coloron / 8) * maxdac / 31);
new_green[coloron] =
(uint8_t)((coloron / 4) * maxdac / 63);
new_blue[coloron] =
(uint8_t)((coloron / 8) * maxdac / 31);
}
break;
default: /* 8, 8, 8 */
for (coloron = 0; coloron < 256; coloron++) {
new_red[coloron] =
(uint8_t)(coloron * maxdac / 255);
new_green[coloron] =
(uint8_t)(coloron * maxdac / 255);
new_blue[coloron] =
(uint8_t)(coloron * maxdac / 255);
}
break;
}
/* Don't set the palet if it matches what we will set. */
for (coloron = 0; coloron < 256; coloron++) {
if ((ast_info.ast_red[coloron] != new_red[coloron]) ||
(ast_info.ast_green[coloron] != new_green[coloron]) ||
(ast_info.ast_blue[coloron] != new_blue[coloron]))
break;
}
if (coloron == 256)
return (0);
ast_info.ast_palet_changed = 1;
for (coloron = 0; coloron < 256; coloron++) {
if (ast_set_reg(DAC_INDEX_WRITE, coloron) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, new_red[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, new_green[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, new_blue[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
}
return (status);
}
int
ast_restore_palet(
void)
{
register uint_t coloron;
register int status = 1;
uchar_t junk;
if (!ast_info.ast_palet_changed)
return (0);
for (coloron = 0; coloron < 256; coloron++) {
if (ast_set_reg(DAC_INDEX_WRITE, coloron) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, ast_info.ast_red[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, ast_info.ast_green[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
if (ast_set_reg(DAC_DATA, ast_info.ast_blue[coloron]) != 0)
status = -1;
if (ast_get_reg(&junk, SEQ_PORT) != 0)
status = -1;
}
ast_info.ast_palet_changed = 0;
return (status);
}
uint_t
ast_color(
register uint_t const red,
register uint_t const green,
register uint_t const blue)
{
register uint_t value;
switch (ast_info.ast_depth) {
case 8: /* 3, 3, 2 */
value = ((red >> 5) & 0x7) << 5;
value |= ((green >> 5) & 0x7) << 2;
value |= (blue >> 6) & 0x3;
break;
case 15: /* 5, 5, 5 */
value = ((red >> 3) & 0x1f) << 10;
value |= ((green >> 3) & 0x1f) << 5;
value |= (blue >> 3) & 0x1f;
break;
case 16: /* 5, 6, 5 */
value = ((red >> 3) & 0x1f) << 11;
value |= ((green >> 2) & 0x3f) << 5;
value |= (blue >> 3) & 0x1f;
break;
default: /* 8, 8, 8 */
value = (red & 0xff) << 16;
value |= (green & 0xff) << 8;
value |= blue & 0xff;
break;
}
return (value);
}
int
ast_open_key(
void)
{
if (ast_set_index_reg(CRTC_PORT, 0x80, 0xA8) != 0)
return (-1);
return (0);
}
int
ast_fill_solid_rect(
register uint_t const x1,
register uint_t const y1,
register uint_t const x2,
register uint_t const y2,
register uint_t const fg)
{
register uint_t cmdreg;
cmdreg = CMD_BITBLT | CMD_PAT_FGCOLOR | 0xf000;
switch (ast_info.ast_pixelsize) {
case 1:
cmdreg |= CMD_COLOR_08;
break;
case 2:
cmdreg |= CMD_COLOR_16;
break;
case 3:
case 4:
default:
cmdreg |= CMD_COLOR_32;
break;
}
if (!ast_store_mmio(MMIOREG_DST_PITCH,
(ast_info.ast_linesize << 16) | MASK_DST_HEIGHT))
return (0);
if (!ast_store_mmio(MMIOREG_FG, fg))
return (0);
if (!ast_store_mmio(MMIOREG_DST_BASE, 0))
return (0);
if (!ast_store_mmio(MMIOREG_DST_XY,
(x1 << 16) | y1))
return (0);
if (!ast_store_mmio(MMIOREG_RECT_XY,
((x2 - x1) << 16) | (y2 - y1)))
return (0);
if (!ast_store_mmio(MMIOREG_CMD, cmdreg))
return (0);
return (1);
}
int
ast_fill_pattern_rect(
register uint_t const x1,
register uint_t const y1,
register uint_t const x2,
register uint_t const y2,
register uint_t const bg,
register uint_t const fg,
register uint64_t const pat)
{
register uint_t cmdreg;
cmdreg = CMD_BITBLT | CMD_PAT_MONOMASK | 0xf000;
switch (ast_info.ast_pixelsize) {
case 1:
cmdreg |= CMD_COLOR_08;
break;
case 2:
cmdreg |= CMD_COLOR_16;
break;
case 3:
case 4:
default:
cmdreg |= CMD_COLOR_32;
break;
}
if (!ast_store_mmio(MMIOREG_DST_PITCH,
(ast_info.ast_linesize << 16) | MASK_DST_HEIGHT))
return (0);
if (!ast_store_mmio(MMIOREG_FG, fg))
return (0);
if (!ast_store_mmio(MMIOREG_BG, bg))
return (0);
if (!ast_store_mmio(MMIOREG_MONO1, (uint_t)(pat >> 32)))
return (0);
if (!ast_store_mmio(MMIOREG_MONO2, (uint_t)pat))
return (0);
if (!ast_store_mmio(MMIOREG_DST_BASE, 0))
return (0);
if (!ast_store_mmio(MMIOREG_DST_XY,
(x1 << 16) | y1))
return (0);
if (!ast_store_mmio(MMIOREG_RECT_XY,
((x2 - x1) << 16) | (y2 - y1)))
return (0);
if (!ast_store_mmio(MMIOREG_CMD, cmdreg))
return (0);
return (1);
}
int
ast_draw_solid_line(
register uint_t const x1,
register uint_t const y1,
register uint_t const x2,
register uint_t const y2,
register uint_t const fg)
{
register uint_t cmdreg;
register uint_t GAbsX;
register uint_t GAbsY;
register uint_t MM;
register uint_t mm;
register int err;
register int k1;
register int k2;
register int xm;
cmdreg = 0xf000 | CMD_LINEDRAW | CMD_ENABLE_CLIP |
CMD_NOT_DRAW_LAST_PIXEL;
switch (ast_info.ast_pixelsize) {
case 1:
cmdreg |= CMD_COLOR_08;
break;
case 2:
cmdreg |= CMD_COLOR_16;
break;
case 3:
case 4:
default:
cmdreg |= CMD_COLOR_32;
break;
}
if (x1 < x2)
GAbsX = x2 - x1;
else
GAbsX = x1 - x2;
if (y1 < y2)
GAbsY = y2 - y1;
else
GAbsY = y1 - y2;
if (GAbsX >= GAbsY) {
MM = GAbsX;
mm = GAbsY;
xm = 1;
} else {
MM = GAbsY;
mm = GAbsX;
xm = 0;
}
if (x1 >= x2)
cmdreg |= CMD_X_DEC;
if (y1 >= y2)
cmdreg |= CMD_Y_DEC;
err = (int)(2 * mm) - (int)MM;
k1 = 2 * mm;
k2 = (int)(2 * mm) - (int)(2 * MM);
if (!ast_store_mmio(MMIOREG_DST_BASE, 0))
return (0);
if (!ast_store_mmio(MMIOREG_DST_PITCH,
(ast_info.ast_linesize << 16) | MASK_DST_HEIGHT))
return (0);
if (!ast_store_mmio(MMIOREG_FG, fg))
return (0);
if (!ast_store_mmio(MMIOREG_LINE_XY,
(x1 << 16) | y1))
return (0);
if (!ast_store_mmio(MMIOREG_LINE_ERR,
(xm << 24) | (err & MASK_LINE_ERR)))
return (0);
if (!ast_store_mmio(MMIOREG_LINE_WIDTH,
(MM & MASK_LINE_WIDTH) << 16))
return (0);
if (!ast_store_mmio(MMIOREG_LINE_K1,
(k1 & MASK_LINE_K1)))
return (0);
if (!ast_store_mmio(MMIOREG_LINE_K2,
(k2 & MASK_LINE_K2)))
return (0);
if (!ast_store_mmio(MMIOREG_CMD, cmdreg))
return (0);
return (1);
}
int
ast_unmap_mem(
register return_packet *const rp,
register int const test)
{
if (ast_unmap_fb() != 0) {
gfx_vts_set_message(rp, 1, test, "unmap framebuffer failed");
return (-1);
}
if (ast_unmap_mmio() != 0) {
gfx_vts_set_message(rp, 1, test, "unmap MMIO failed");
return (-1);
}
return (0);
}
int
ast_unmap_fb(
void)
{
register int status;
if (ast_info.ast_fb_ptr == NULL)
return (0);
status = munmap((char *)ast_info.ast_fb_ptr, ast_info.ast_fb_size);
ast_info.ast_fb_ptr = NULL;
return (status);
}
int
ast_unmap_mmio(
void)
{
register int status;
if (ast_info.ast_mmio_ptr == NULL)
return (0);
status = munmap((char *)ast_info.ast_mmio_ptr,
ast_info.ast_mmio_size);
ast_info.ast_mmio_ptr = NULL;
return (status);
}
int
ast_store_mmio(
register uint_t const port,
register uint_t const value)
{
register uint_t readvalue;
register hrtime_t starttime;
register hrtime_t curtime;
register hrtime_t endtime;
register ulong_t count = 0;
ast_mmio_write32(port, value);
readvalue = ast_mmio_read32(port);
if (readvalue == value)
return (1);
starttime = gethrtime();
endtime = starttime + ast_loop_time;
do {
count++;
ast_mmio_write32(port, value);
readvalue = ast_mmio_read32(port);
if (readvalue == value)
return (1);
curtime = gethrtime();
} while (curtime < endtime);
ast_mmio_write32(port, value);
readvalue = ast_mmio_read32(port);
if (readvalue == value)
return (1);
return (0);
}
int
ast_get_index_reg(
register uchar_t *const valueptr,
register uchar_t const offset,
register uchar_t const index)
{
if (ast_set_reg(offset, index) != 0)
return (-1);
if (ast_get_reg(valueptr, offset + 1) != 0)
return (-1);
return (0);
}
int
ast_set_index_reg(
register uchar_t const offset,
register uchar_t const index,
register uchar_t const value)
{
if (ast_set_reg(offset, index) != 0)
return (-1);
if (ast_set_reg(offset + 1, value) != 0)
return (-1);
return (0);
}
int
ast_get_reg(
register uchar_t *const valueptr,
register uchar_t const offset)
{
ast_io_reg io_reg;
io_reg.offset = offset;
io_reg.value = (uchar_t)-1;
if (ioctl(ast_info.ast_fd, AST_GET_IO_REG, &io_reg) != 0)
return (-1);
*valueptr = io_reg.value;
return (0);
}
int
ast_set_reg(
register uchar_t const offset,
register uchar_t const value)
{
ast_io_reg io_reg;
io_reg.offset = offset;
io_reg.value = value;
if (ioctl(ast_info.ast_fd, AST_SET_IO_REG, &io_reg) != 0)
return (-1);
return (0);
}
uint_t
ast_mmio_read32(
register uint_t const port)
{
register uint_t volatile const *const addr =
(uint_t volatile const *) (ast_info.ast_mmio_ptr + port);
register uint_t value;
union {
uint_t l;
ushort_t w[2];
uchar_t b[4];
} data;
data.l = *addr;
switch (ast_info.ast_endian) {
case 0: /* little endian */
value = ((uint_t)data.b[3] << 24) |
((uint_t)data.b[2] << 16) |
((uint_t)data.b[1] << 8) |
(uint_t)data.b[0];
break;
case 1: /* big endian 16 */
case 2: /* big endian 32 */
value = ((uint_t)data.b[0] << 24) |
((uint_t)data.b[1] << 16) |
((uint_t)data.b[2] << 8) |
(uint_t)data.b[3];
break;
}
return (value);
}
void
ast_mmio_write32(
register uint_t const port,
register uint_t const val)
{
register uint_t volatile *const addr =
(uint_t volatile *) (ast_info.ast_mmio_ptr + port);
register uint_t value;
union {
uint_t l;
ushort_t w[2];
uchar_t b[4];
} data;
data.l = val;
switch (ast_info.ast_endian) {
case 0: /* little endian */
value = ((uint_t)data.b[3] << 24) |
((uint_t)data.b[2] << 16) |
((uint_t)data.b[1] << 8) |
(uint_t)data.b[0];
break;
case 1: /* big endian 16 */
case 2: /* big endian 32 */
value = ((uint_t)data.b[0] << 24) |
((uint_t)data.b[1] << 16) |
((uint_t)data.b[2] << 8) |
(uint_t)data.b[3];
break;
}
*addr = value;
}
int
ast_wait_idle(
void)
{
register hrtime_t starttime;
register hrtime_t curtime;
register hrtime_t endtime;
register ulong_t count = 0;
if (!(ast_mmio_read32(MMIOREG_STAT) & STAT_BUSY))
return (1);
starttime = gethrtime();
endtime = starttime + ast_loop_time;
do {
count++;
if (!(ast_mmio_read32(MMIOREG_STAT) & STAT_BUSY))
return (1);
curtime = gethrtime();
} while (curtime < endtime);
if (!(ast_mmio_read32(MMIOREG_STAT) & STAT_BUSY))
return (1);
return (0);
}