static int
find_videomode(struct vesa_info *vesa_info, struct vesa_mode_info *mode_info
, int width, int height)
{
dprintf(3, "Finding vesa mode with dimensions %d/%d\n", width, height);
u16 *videomodes = SEGOFF_TO_FLATPTR(vesa_info->video_mode_ptr);
for (;; videomodes++) {
u16 videomode = *videomodes;
if (videomode == 0xffff) {
dprintf(1, "Unable to find vesa video mode dimensions %d/%d\n"
, width, height);
return -1;
}
struct bregs br;
memset(&br, 0, sizeof(br));
br.ax = 0x4f01;
br.cx = (1 << 14) | videomode;
br.di = FLATPTR_TO_OFFSET(mode_info);
br.es = FLATPTR_TO_SEG(mode_info);
call16_int10(&br);
if (br.ax != 0x4f) {
dprintf(1, "get_mode failed.\n");
continue;
}
if (mode_info->x_resolution != width
|| mode_info->y_resolution != height)
continue;
u8 depth = mode_info->bits_per_pixel;
if (depth != 16 && depth != 24 && depth != 32)
continue;
return videomode;
}
}
/* Legacy16GetTableAddress */
static void
handle_csm_0006(struct bregs *regs)
{
u16 size = regs->cx;
u16 align = regs->dx;
u16 region = regs->bx; // (1 for F000 seg, 2 for E000 seg, 0 for either)
void *chunk = NULL;
if (!region)
region = 3;
dprintf(3, "Legacy16GetTableAddress size %x align %x region %d\n",
size, align, region);
if (region & 2)
chunk = _malloc(&ZoneLow, size, align);
if (!chunk && (region & 1))
chunk = _malloc(&ZoneFSeg, size, align);
dprintf(3, "Legacy16GetTableAddress size %x align %x region %d yields %p\n",
size, align, region, chunk);
if (chunk) {
regs->ds = FLATPTR_TO_SEG(chunk);
regs->bx = FLATPTR_TO_OFFSET(chunk);
regs->ax = 0;
} else {
regs->ax = 1;
}
}
int
ehci_poll_intr(struct usb_pipe *p, void *data)
{
ASSERT16();
if (! CONFIG_USB_EHCI)
return -1;
struct ehci_pipe *pipe = container_of(p, struct ehci_pipe, pipe);
struct ehci_qtd *td = GET_FLATPTR(pipe->next_td);
u32 token = GET_FLATPTR(td->token);
if (token & QTD_STS_ACTIVE)
// No intrs found.
return -1;
// XXX - check for errors.
// Copy data.
int maxpacket = GET_FLATPTR(pipe->pipe.maxpacket);
int pos = td - GET_FLATPTR(pipe->tds);
void *tddata = GET_FLATPTR(pipe->data) + maxpacket * pos;
memcpy_far(GET_SEG(SS), data
, FLATPTR_TO_SEG(tddata), (void*)FLATPTR_TO_OFFSET(tddata)
, maxpacket);
// Reenable this td.
struct ehci_qtd *next = (void*)(GET_FLATPTR(td->qtd_next) & ~EHCI_PTR_BITS);
SET_FLATPTR(pipe->next_td, next);
SET_FLATPTR(td->buf[0], (u32)tddata);
barrier();
SET_FLATPTR(td->token, (ehci_explen(maxpacket) | QTD_STS_ACTIVE
| QTD_PID_IN | ehci_maxerr(3)));
return 0;
}
int
ohci_poll_intr(struct usb_pipe *pipe, void *data)
{
ASSERT16();
if (! CONFIG_USB_OHCI)
return -1;
struct ohci_pipe *p = container_of(pipe, struct ohci_pipe, pipe);
struct ohci_td *tds = GET_FLATPTR(p->tds);
struct ohci_td *head = (void*)GET_FLATPTR(p->ed.hwHeadP);
struct ohci_td *tail = (void*)GET_FLATPTR(p->ed.hwTailP);
int count = GET_FLATPTR(p->count);
int pos = (tail - tds + 1) % count;
struct ohci_td *next = &tds[pos];
if (head == next)
// No intrs found.
return -1;
// XXX - check for errors.
// Copy data.
u32 endp = GET_FLATPTR(p->pipe.endp);
int maxpacket = endp2maxsize(endp);
void *pipedata = GET_FLATPTR(p->data);
void *intrdata = pipedata + maxpacket * pos;
memcpy_far(GET_SEG(SS), data
, FLATPTR_TO_SEG(intrdata), (void*)FLATPTR_TO_OFFSET(intrdata)
, maxpacket);
// Reenable this td.
SET_FLATPTR(tail->hwINFO, TD_DP_IN | TD_T_TOGGLE | TD_CC);
intrdata = pipedata + maxpacket * (tail-tds);
SET_FLATPTR(tail->hwCBP, (u32)intrdata);
SET_FLATPTR(tail->hwNextTD, (u32)next);
SET_FLATPTR(tail->hwBE, (u32)intrdata + maxpacket - 1);
SET_FLATPTR(p->ed.hwTailP, (u32)next);
return 0;
}
void
enable_bootsplash(void)
{
if (!CONFIG_BOOTSPLASH)
return;
dprintf(3, "Checking for bootsplash\n");
u32 file = romfile_find("bootsplash.jpg");
if (!file)
return;
int filesize = romfile_size(file);
u8 *picture = NULL;
u8 *filedata = malloc_tmphigh(filesize);
struct vesa_info *vesa_info = malloc_tmplow(sizeof(*vesa_info));
struct vesa_mode_info *mode_info = malloc_tmplow(sizeof(*mode_info));
struct jpeg_decdata *jpeg = jpeg_alloc();
if (!filedata || !jpeg || !vesa_info || !mode_info) {
warn_noalloc();
goto done;
}
/* Check whether we have a VESA 2.0 compliant BIOS */
memset(vesa_info, 0, sizeof(struct vesa_info));
vesa_info->vesa_signature = VBE2_SIGNATURE;
struct bregs br;
memset(&br, 0, sizeof(br));
br.ax = 0x4f00;
br.di = FLATPTR_TO_OFFSET(vesa_info);
br.es = FLATPTR_TO_SEG(vesa_info);
call16_int10(&br);
if (vesa_info->vesa_signature != VESA_SIGNATURE) {
dprintf(1,"No VBE2 found.\n");
goto done;
}
/* Print some debugging information about our card. */
char *vendor = SEGOFF_TO_FLATPTR(vesa_info->oem_vendor_name_ptr);
char *product = SEGOFF_TO_FLATPTR(vesa_info->oem_product_name_ptr);
dprintf(3, "VESA %d.%d\nVENDOR: %s\nPRODUCT: %s\n",
vesa_info->vesa_version>>8, vesa_info->vesa_version&0xff,
vendor, product);
// Parse jpeg and get image size.
dprintf(5, "Copying bootsplash.jpg\n");
romfile_copy(file, filedata, filesize);
dprintf(5, "Decoding bootsplash.jpg\n");
int ret = jpeg_decode(jpeg, filedata);
if (ret) {
dprintf(1, "jpeg_decode failed with return code %d...\n", ret);
goto done;
}
int width, height;
jpeg_get_size(jpeg, &width, &height);
// Try to find a graphics mode with the corresponding dimensions.
int videomode = find_videomode(vesa_info, mode_info, width, height);
if (videomode < 0)
goto done;
void *framebuffer = mode_info->phys_base_ptr;
int depth = mode_info->bits_per_pixel;
dprintf(3, "mode: %04x\n", videomode);
dprintf(3, "framebuffer: %p\n", framebuffer);
dprintf(3, "bytes per scanline: %d\n", mode_info->bytes_per_scanline);
dprintf(3, "bits per pixel: %d\n", depth);
// Allocate space for image and decompress it.
int imagesize = width * height * (depth / 8);
picture = malloc_tmphigh(imagesize);
if (!picture) {
warn_noalloc();
goto done;
}
dprintf(5, "Decompressing bootsplash.jpg\n");
ret = jpeg_show(jpeg, picture, width, height, depth);
if (ret) {
dprintf(1, "jpeg_show failed with return code %d...\n", ret);
goto done;
}
/* Switch to graphics mode */
dprintf(5, "Switching to graphics mode\n");
memset(&br, 0, sizeof(br));
br.ax = 0x4f02;
br.bx = (1 << 14) | videomode;
call16_int10(&br);
if (br.ax != 0x4f) {
dprintf(1, "set_mode failed.\n");
goto done;
}
/* Show the picture */
dprintf(5, "Showing bootsplash.jpg\n");
iomemcpy(framebuffer, picture, imagesize);
dprintf(5, "Bootsplash copy complete\n");
BootsplashActive = 1;
done:
free(filedata);
free(picture);
free(vesa_info);
free(mode_info);
free(jpeg);
return;
}
void
enable_bootsplash(void)
{
if (!CONFIG_BOOTSPLASH)
return;
/* splash picture can be bmp or jpeg file */
dprintf(3, "Checking for bootsplash\n");
u8 type = 0; /* 0 means jpg, 1 means bmp, default is 0=jpg */
int filesize;
u8 *filedata = romfile_loadfile("bootsplash.jpg", &filesize);
if (!filedata) {
filedata = romfile_loadfile("bootsplash.bmp", &filesize);
if (!filedata)
return;
type = 1;
}
dprintf(3, "start showing bootsplash\n");
u8 *picture = NULL; /* data buff used to be flushed to the video buf */
struct jpeg_decdata *jpeg = NULL;
struct bmp_decdata *bmp = NULL;
struct vbe_info *vesa_info = malloc_tmplow(sizeof(*vesa_info));
struct vbe_mode_info *mode_info = malloc_tmplow(sizeof(*mode_info));
if (!vesa_info || !mode_info) {
warn_noalloc();
goto done;
}
/* Check whether we have a VESA 2.0 compliant BIOS */
memset(vesa_info, 0, sizeof(struct vbe_info));
vesa_info->signature = VBE2_SIGNATURE;
struct bregs br;
memset(&br, 0, sizeof(br));
br.ax = 0x4f00;
br.di = FLATPTR_TO_OFFSET(vesa_info);
br.es = FLATPTR_TO_SEG(vesa_info);
call16_int10(&br);
if (vesa_info->signature != VESA_SIGNATURE) {
dprintf(1,"No VBE2 found.\n");
goto done;
}
/* Print some debugging information about our card. */
char *vendor = SEGOFF_TO_FLATPTR(vesa_info->oem_vendor_string);
char *product = SEGOFF_TO_FLATPTR(vesa_info->oem_product_string);
dprintf(3, "VESA %d.%d\nVENDOR: %s\nPRODUCT: %s\n",
vesa_info->version>>8, vesa_info->version&0xff,
vendor, product);
int ret, width, height;
int bpp_require = 0;
if (type == 0) {
jpeg = jpeg_alloc();
if (!jpeg) {
warn_noalloc();
goto done;
}
/* Parse jpeg and get image size. */
dprintf(5, "Decoding bootsplash.jpg\n");
ret = jpeg_decode(jpeg, filedata);
if (ret) {
dprintf(1, "jpeg_decode failed with return code %d...\n", ret);
goto done;
}
jpeg_get_size(jpeg, &width, &height);
} else {
bmp = bmp_alloc();
if (!bmp) {
warn_noalloc();
goto done;
}
/* Parse bmp and get image size. */
dprintf(5, "Decoding bootsplash.bmp\n");
ret = bmp_decode(bmp, filedata, filesize);
if (ret) {
dprintf(1, "bmp_decode failed with return code %d...\n", ret);
goto done;
}
bmp_get_size(bmp, &width, &height);
bpp_require = 24;
}
/* jpeg would use 16 or 24 bpp video mode, BMP use 24bpp mode only */
// Try to find a graphics mode with the corresponding dimensions.
int videomode = find_videomode(vesa_info, mode_info, width, height,
bpp_require);
if (videomode < 0) {
dprintf(1, "failed to find a videomode with %dx%d %dbpp (0=any).\n",
width, height, bpp_require);
goto done;
}
void *framebuffer = (void *)mode_info->phys_base;
int depth = mode_info->bits_per_pixel;
dprintf(3, "mode: %04x\n", videomode);
dprintf(3, "framebuffer: %p\n", framebuffer);
dprintf(3, "bytes per scanline: %d\n", mode_info->bytes_per_scanline);
dprintf(3, "bits per pixel: %d\n", depth);
// Allocate space for image and decompress it.
int imagesize = height * mode_info->bytes_per_scanline;
picture = malloc_tmphigh(imagesize);
if (!picture) {
warn_noalloc();
goto done;
}
if (type == 0) {
dprintf(5, "Decompressing bootsplash.jpg\n");
ret = jpeg_show(jpeg, picture, width, height, depth,
mode_info->bytes_per_scanline);
if (ret) {
dprintf(1, "jpeg_show failed with return code %d...\n", ret);
goto done;
}
} else {
dprintf(5, "Decompressing bootsplash.bmp\n");
ret = bmp_show(bmp, picture, width, height, depth,
mode_info->bytes_per_scanline);
if (ret) {
dprintf(1, "bmp_show failed with return code %d...\n", ret);
goto done;
}
}
/* Switch to graphics mode */
dprintf(5, "Switching to graphics mode\n");
memset(&br, 0, sizeof(br));
br.ax = 0x4f02;
br.bx = videomode | VBE_MODE_LINEAR_FRAME_BUFFER;
call16_int10(&br);
if (br.ax != 0x4f) {
dprintf(1, "set_mode failed.\n");
goto done;
}
/* Show the picture */
dprintf(5, "Showing bootsplash picture\n");
iomemcpy(framebuffer, picture, imagesize);
dprintf(5, "Bootsplash copy complete\n");
BootsplashActive = 1;
done:
free(filedata);
free(picture);
free(vesa_info);
free(mode_info);
free(jpeg);
free(bmp);
return;
}