Copyright 1999, Be Incorporated. All Rights Reserved.
This file may be used under the terms of the Be Sample Code License.
Other authors:
Mark Watson;
Rudolf Cornelissen 3/2002-1/2006.
*/
#include <KernelExport.h>
#include <PCI.h>
#include <OS.h>
#include <directories.h>
#include <driver_settings.h>
#include <malloc.h>
#include <stdlib.h>
#include <graphic_driver.h>
#include <stdio.h>
#include <string.h>
#include "DriverInterface.h"
#include "mga_macros.h"
#define get_pci(o, s) (*pci_bus->read_pci_config)(pcii->bus, pcii->device, pcii->function, (o), (s))
#define set_pci(o, s, v) (*pci_bus->write_pci_config)(pcii->bus, pcii->device, pcii->function, (o), (s), (v))
#define MAX_DEVICES 8
int32 api_version = B_CUR_DRIVER_API_VERSION;
typedef struct device_info device_info;
typedef struct {
timer te;
device_info *di;
bigtime_t when_target;
} timer_info;
struct device_info {
uint32 is_open;
area_id shared_area;
shared_info *si;
vuint32 *regs;
pci_info pcii;
char name[B_OS_NAME_LENGTH];
uint8 rom_mirror[32768];
};
typedef struct {
uint32 count;
benaphore kernel;
char *device_names[MAX_DEVICES+1];
device_info di[MAX_DEVICES];
} DeviceData;
static status_t open_hook (const char* name, uint32 flags, void** cookie);
static status_t close_hook (void* dev);
static status_t free_hook (void* dev);
static status_t read_hook (void* dev, off_t pos, void* buf, size_t* len);
static status_t write_hook (void* dev, off_t pos, const void* buf, size_t* len);
static status_t control_hook (void* dev, uint32 msg, void *buf, size_t len);
static status_t map_device(device_info *di);
static void unmap_device(device_info *di);
static void copy_rom(device_info *di);
static void probe_devices(void);
static int32 gx00_interrupt(void *data);
static DeviceData *pd;
static pci_module_info *pci_bus;
static device_hooks graphics_device_hooks = {
open_hook,
close_hook,
free_hook,
control_hook,
read_hook,
write_hook,
NULL,
NULL,
NULL,
NULL
};
#define VENDOR_ID 0x102b /* Matrox graphics inc. */
static uint16 gx00_device_list[] = {
0x2527,
0x0525,
0x0520,
0x0521,
0x1000,
0x1001,
0x051B,
0x051F,
0x0519,
0
};
static struct {
uint16 vendor;
uint16 *devices;
} SupportedDevices[] = {
{VENDOR_ID, gx00_device_list},
{0x0000, NULL}
};
static settings current_settings =
{
DRIVER_PREFIX ".accelerant",
"none",
false,
0x00000000,
0,
false,
false,
false,
};
static void dumprom (void *rom, size_t size, pci_info pcii)
{
int fd;
char fname[64];
sprintf (fname, kUserDirectory "/" DRIVER_PREFIX "." DEVICE_FORMAT ".rom",
pcii.vendor_id, pcii.device_id, pcii.bus, pcii.device, pcii.function);
fd = open (fname, O_WRONLY | O_CREAT, 0666);
if (fd < 0) return;
write (fd, rom, size);
close (fd);
}
static int caused_vbi(vuint32 * regs)
{
return (ACCR(STATUS)&0x20);
}
static void clear_vbi(vuint32 * regs)
{
ACCW(ICLEAR,0x20);
}
static void enable_vbi(vuint32 * regs)
{
ACCW(IEN,ACCR(IEN)|0x20);
}
static void disable_vbi(vuint32 * regs)
{
ACCW(IEN,(ACCR(IEN)&~0x20));
ACCW(ICLEAR,0x20);
}
init_hardware() - Returns B_OK if one is
found, otherwise returns B_ERROR so the driver will be unloaded.
*/
status_t
init_hardware(void) {
long pci_index = 0;
pci_info pcii;
bool found_one = FALSE;
if (get_module(B_PCI_MODULE_NAME, (module_info **)&pci_bus) != B_OK)
return B_ERROR;
while ((*pci_bus->get_nth_pci_info)(pci_index, &pcii) == B_NO_ERROR) {
int vendor = 0;
while (SupportedDevices[vendor].vendor) {
if (SupportedDevices[vendor].vendor == pcii.vendor_id) {
uint16 *devices = SupportedDevices[vendor].devices;
while (*devices) {
if (*devices == pcii.device_id ) {
found_one = TRUE;
goto done;
}
devices++;
}
}
vendor++;
}
pci_index++;
}
done:
put_module(B_PCI_MODULE_NAME);
return (found_one ? B_OK : B_ERROR);
}
status_t
init_driver(void) {
void *settings_handle;
settings_handle = load_driver_settings (DRIVER_PREFIX ".settings");
if (settings_handle != NULL) {
const char *item;
char *end;
uint32 value;
item = get_driver_parameter (settings_handle, "accelerant", "", "");
if ((strlen (item) > 0) && (strlen (item) < sizeof (current_settings.accelerant) - 1)) {
strcpy (current_settings.accelerant, item);
}
item = get_driver_parameter (settings_handle, "primary", "", "");
if ((strlen (item) > 0) && (strlen (item) < sizeof (current_settings.primary) - 1)) {
strcpy (current_settings.primary, item);
}
current_settings.dumprom = get_driver_boolean_parameter (settings_handle, "dumprom", false, false);
item = get_driver_parameter (settings_handle, "logmask", "0x00000000", "0x00000000");
value = strtoul (item, &end, 0);
if (*end == '\0') current_settings.logmask = value;
item = get_driver_parameter (settings_handle, "memory", "0", "0");
value = strtoul (item, &end, 0);
if (*end == '\0') current_settings.memory = value;
current_settings.hardcursor = get_driver_boolean_parameter (settings_handle, "hardcursor", false, false);
current_settings.usebios = get_driver_boolean_parameter (settings_handle, "usebios", false, false);
current_settings.greensync = get_driver_boolean_parameter (settings_handle, "greensync", false, false);
unload_driver_settings (settings_handle);
}
if (get_module(B_PCI_MODULE_NAME, (module_info **)&pci_bus) != B_OK)
return B_ERROR;
pd = (DeviceData *)calloc(1, sizeof(DeviceData));
if (!pd) {
put_module(B_PCI_MODULE_NAME);
return B_ERROR;
}
INIT_BEN(pd->kernel);
probe_devices();
return B_OK;
}
const char **
publish_devices(void) {
return (const char **)pd->device_names;
}
device_hooks *
find_device(const char *name) {
int index = 0;
while (pd->device_names[index]) {
if (strcmp(name, pd->device_names[index]) == 0)
return &graphics_device_hooks;
index++;
}
return NULL;
}
void uninit_driver(void) {
DELETE_BEN(pd->kernel);
free(pd);
pd = NULL;
put_module(B_PCI_MODULE_NAME);
}
static status_t map_device(device_info *di)
{
char buffer[B_OS_NAME_LENGTH];
shared_info *si = di->si;
uint32 tmpUlong;
pci_info *pcii = &(di->pcii);
system_info sysinfo;
uint8 *rom_temp;
area_id rom_area;
* MIL2 and later have frame_buffer in [0], control_regs in [1], pseudo_dma in [2] */
int frame_buffer = 0;
int registers = 1;
int pseudo_dma = 2;
if (di->pcii.device_id == 0x0519)
{
frame_buffer = 1;
registers = 0;
}
tmpUlong = get_pci(PCI_command, 4);
tmpUlong |= 0x00000002;
tmpUlong &= 0xfffffffe;
set_pci(PCI_command, 4, tmpUlong);
get_system_info(&sysinfo);
if (0)
{
si->use_clone_bugfix = 1;
}
else
{
si->use_clone_bugfix = 0;
}
sprintf(buffer, DEVICE_FORMAT " regs",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
si->regs_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[registers],
di->pcii.u.h0.base_register_sizes[registers],
B_ANY_KERNEL_ADDRESS,
B_CLONEABLE_AREA | (si->use_clone_bugfix ? B_READ_AREA|B_WRITE_AREA : 0),
(void **)&(di->regs));
si->clone_bugfix_regs = (uint32 *) di->regs;
if (si->regs_area < 0) return si->regs_area;
sprintf(buffer, DEVICE_FORMAT " rom",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
tmpUlong = di->pcii.u.h0.base_registers[frame_buffer];
tmpUlong |= 0x00000001;
set_pci(PCI_rom_base, 4, tmpUlong);
rom_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[frame_buffer],
32768,
B_ANY_KERNEL_ADDRESS,
B_KERNEL_READ_AREA,
(void **)&(rom_temp)
);
if (rom_area < 0) {
delete_area(si->regs_area);
si->regs_area = -1;
return rom_area;
}
* primary card's BIOS for our reference too if we aren't primary ourselves.
* (confirmed OK on 'quad' G200MMS.) */
if ((di->pcii.class_base == PCI_display) &&
(di->pcii.class_sub == PCI_display_other) &&
((rom_temp[0] != 0x55) || (rom_temp[1] != 0xaa)) && di->pcii.device)
{
* (MMS cards have a own bridge: so there are only graphics cards on it's bus). */
uint8 index = 0;
bool found = false;
for (index = 0; index < pd->count; index++)
{
if ((pd->di[index].pcii.bus == di->pcii.bus) &&
(pd->di[index].pcii.device == 0x00))
{
found = true;
break;
}
}
if (found)
{
memcpy (si->rom_mirror, pd->di[index].rom_mirror, 32768);
}
else
{
memcpy (si->rom_mirror, rom_temp, 32768);
}
}
else
{
memcpy (si->rom_mirror, rom_temp, 32768);
}
if (current_settings.dumprom) dumprom (si->rom_mirror, 32768, di->pcii);
set_pci(PCI_rom_base,4,0);
delete_area(rom_area);
if (di->pcii.device_id != 0x0519)
{
sprintf(buffer, DEVICE_FORMAT " pseudodma",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
si->pseudo_dma_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[pseudo_dma],
di->pcii.u.h0.base_register_sizes[pseudo_dma],
B_ANY_KERNEL_ADDRESS,
B_WRITE_AREA,
&(si->pseudo_dma));
if (si->pseudo_dma_area < 0) {
delete_area(si->regs_area);
si->regs_area = -1;
return si->pseudo_dma_area;
}
}
sprintf(buffer, DEVICE_FORMAT " framebuffer",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
si->fb_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[frame_buffer],
di->pcii.u.h0.base_register_sizes[frame_buffer],
B_ANY_KERNEL_BLOCK_ADDRESS | B_WRITE_COMBINING_MEMORY,
B_READ_AREA | B_WRITE_AREA | B_CLONEABLE_AREA,
&(si->framebuffer));
if (si->fb_area < 0) {
si->fb_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[frame_buffer],
di->pcii.u.h0.base_register_sizes[frame_buffer],
B_ANY_KERNEL_BLOCK_ADDRESS,
B_READ_AREA | B_WRITE_AREA | B_CLONEABLE_AREA,
&(si->framebuffer));
}
if (si->fb_area < 0)
{
if (di->pcii.device_id != 0x0519)
{
delete_area(si->dma_buffer_area);
si->dma_buffer_area = -1;
delete_area(si->pseudo_dma_area);
si->pseudo_dma_area = -1;
}
delete_area(si->regs_area);
si->regs_area = -1;
return si->fb_area;
}
si->framebuffer_pci = (void *)(addr_t)di->pcii.u.h0.base_registers_pci[frame_buffer];
si->settings = current_settings;
return si->fb_area;
}
static void unmap_device(device_info *di) {
shared_info *si = di->si;
uint32 tmpUlong;
pci_info *pcii = &(di->pcii);
tmpUlong = get_pci(PCI_command, 4);
tmpUlong &= 0xfffffffc;
set_pci(PCI_command, 4, tmpUlong);
if (si->regs_area >= 0) delete_area(si->regs_area);
if (si->fb_area >= 0) delete_area(si->fb_area);
si->regs_area = si->fb_area = -1;
if (di->pcii.device_id != 0x0519)
{
delete_area(si->dma_buffer_area);
si->dma_buffer_area = -1;
delete_area(si->pseudo_dma_area);
si->pseudo_dma_area = -1;
}
si->framebuffer = NULL;
di->regs = NULL;
}
static void copy_rom(device_info *di)
{
char buffer[B_OS_NAME_LENGTH];
uint8 *rom_temp;
area_id rom_area;
uint32 tmpUlong;
pci_info *pcii = &(di->pcii);
int frame_buffer = 0;
if (di->pcii.device_id == 0x0519) frame_buffer = 1;
tmpUlong = get_pci(PCI_command, 4);
tmpUlong |= 0x00000002;
tmpUlong &= 0xfffffffe;
set_pci(PCI_command, 4, tmpUlong);
sprintf(buffer, DEVICE_FORMAT " rom",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
tmpUlong = di->pcii.u.h0.base_registers[frame_buffer];
tmpUlong |= 0x00000001;
set_pci(PCI_rom_base, 4, tmpUlong);
rom_area = map_physical_memory(
buffer,
di->pcii.u.h0.base_registers[frame_buffer],
32768,
B_ANY_KERNEL_ADDRESS,
B_KERNEL_READ_AREA,
(void **)&(rom_temp)
);
if (rom_area >= 0)
{
memcpy (di->rom_mirror, rom_temp, 32768);
set_pci(PCI_rom_base, 4, 0);
delete_area(rom_area);
}
tmpUlong = get_pci(PCI_command, 4);
tmpUlong &= 0xfffffffc;
set_pci(PCI_command, 4, tmpUlong);
}
static void probe_devices(void)
{
uint32 pci_index = 0;
uint32 count = 0;
device_info *di = pd->di;
char tmp_name[B_OS_NAME_LENGTH];
while ((count < MAX_DEVICES) && ((*pci_bus->get_nth_pci_info)(pci_index, &(di->pcii)) == B_NO_ERROR))
{
int vendor = 0;
while (SupportedDevices[vendor].vendor)
{
if (SupportedDevices[vendor].vendor == di->pcii.vendor_id)
{
uint16 *devices = SupportedDevices[vendor].devices;
while (*devices)
{
if (*devices == di->pcii.device_id )
{
sprintf(tmp_name, DEVICE_FORMAT,
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
* hierarchy folder, so the system will use it as primary adaptor if requested
* via mga.settings. */
if (strcmp(tmp_name, current_settings.primary) == 0)
sprintf(tmp_name, "-%s", current_settings.primary);
sprintf(di->name, "graphics/%s", tmp_name);
pd->device_names[count] = di->name;
di->is_open = 0;
di->shared_area = -1;
di->si = NULL;
* they might only have a ROM on the primary adaptor.
* (Confirmed G200MMS.) */
copy_rom(di);
di++;
count++;
goto next_device;
}
devices++;
}
}
vendor++;
}
next_device:
pci_index++;
}
pd->count = count;
pd->device_names[pd->count] = NULL;
}
static uint32 thread_interrupt_work(int32 *flags, vuint32 *regs, shared_info *si) {
uint32 handled = B_HANDLED_INTERRUPT;
if (si->vblank >= 0) {
int32 blocked;
if ((get_sem_count(si->vblank, &blocked) == B_OK) && (blocked < 0)) {
release_sem_etc(si->vblank, -blocked, B_DO_NOT_RESCHEDULE);
handled = B_INVOKE_SCHEDULER;
}
}
return handled;
}
static int32
gx00_interrupt(void *data)
{
int32 handled = B_UNHANDLED_INTERRUPT;
device_info *di = (device_info *)data;
shared_info *si = di->si;
int32 *flags = (int32*)&(si->flags);
vuint32 *regs;
if (atomic_or(flags, SKD_HANDLER_INSTALLED) & SKD_HANDLER_INSTALLED) {
goto exit0;
}
regs = di->regs;
if (caused_vbi(regs)) {
clear_vbi(regs);
handled = thread_interrupt_work(flags, regs, si);
}
atomic_and(flags, ~SKD_HANDLER_INSTALLED);
exit0:
return handled;
}
static status_t open_hook (const char* name, uint32 flags, void** cookie) {
int32 index = 0;
device_info *di;
shared_info *si;
thread_id thid;
thread_info thinfo;
status_t result = B_OK;
char shared_name[B_OS_NAME_LENGTH];
while (pd->device_names[index] && (strcmp(name, pd->device_names[index]) != 0)) index++;
di = &(pd->di[index]);
AQUIRE_BEN(pd->kernel);
if (di->is_open) {
goto mark_as_open;
}
sprintf(shared_name, DEVICE_FORMAT " shared",
di->pcii.vendor_id, di->pcii.device_id,
di->pcii.bus, di->pcii.device, di->pcii.function);
di->shared_area = create_area(shared_name, (void **)&(di->si), B_ANY_KERNEL_ADDRESS,
((sizeof(shared_info) + (B_PAGE_SIZE - 1)) & ~(B_PAGE_SIZE - 1)), B_FULL_LOCK,
B_KERNEL_READ_AREA | B_KERNEL_WRITE_AREA | B_CLONEABLE_AREA);
if (di->shared_area < 0) {
result = di->shared_area;
goto done;
}
si = di->si;
si->vendor_id = di->pcii.vendor_id;
si->device_id = di->pcii.device_id;
si->revision = di->pcii.revision;
si->bus = di->pcii.bus;
si->device = di->pcii.device;
si->function = di->pcii.function;
si->accelerant_in_use = false;
result = map_device(di);
if (result < 0) goto free_shared;
result = B_OK;
disable_vbi(di->regs);
si->ps.int_assigned = false;
si->vblank = create_sem(0, di->name);
if (si->vblank < 0) goto mark_as_open;
thid = find_thread(NULL);
get_thread_info(thid, &thinfo);
set_sem_owner(si->vblank, thinfo.team);
if ((di->pcii.u.h0.interrupt_pin == 0x00) ||
(di->pcii.u.h0.interrupt_line == 0xff) ||
(di->pcii.u.h0.interrupt_line <= 0x02))
{
delete_sem(si->vblank);
si->vblank = -1;
}
else
{
result = install_io_interrupt_handler(di->pcii.u.h0.interrupt_line, gx00_interrupt, (void *)di, 0);
if (result != B_OK)
{
delete_sem(si->vblank);
si->vblank = -1;
}
else
{
si->ps.int_assigned = true;
}
}
mark_as_open:
di->is_open++;
*cookie = di;
goto done;
free_shared:
delete_area(di->shared_area);
di->shared_area = -1;
di->si = NULL;
done:
RELEASE_BEN(pd->kernel);
return result;
}
read_hook - does nothing, gracefully
----- */
static status_t
read_hook (void* dev, off_t pos, void* buf, size_t* len)
{
*len = 0;
return B_NOT_ALLOWED;
}
write_hook - does nothing, gracefully
----- */
static status_t
write_hook (void* dev, off_t pos, const void* buf, size_t* len)
{
*len = 0;
return B_NOT_ALLOWED;
}
close_hook - does nothing, gracefully
----- */
static status_t
close_hook (void* dev)
{
return B_NO_ERROR;
}
free_hook - close down the device
----------- */
static status_t
free_hook (void* dev) {
device_info *di = (device_info *)dev;
shared_info *si = di->si;
vuint32 *regs = di->regs;
AQUIRE_BEN(pd->kernel);
if (di->is_open > 1)
goto unlock_and_exit;
disable_vbi(regs);
if (si->ps.int_assigned)
{
remove_io_interrupt_handler(di->pcii.u.h0.interrupt_line, gx00_interrupt, di);
delete_sem(si->vblank);
si->vblank = -1;
}
unmap_device(di);
delete_area(di->shared_area);
di->shared_area = -1;
di->si = NULL;
unlock_and_exit:
di->is_open--;
RELEASE_BEN(pd->kernel);
return B_OK;
}
control_hook - where the real work is done
----------- */
static status_t
control_hook (void* dev, uint32 msg, void *buf, size_t len) {
device_info *di = (device_info *)dev;
status_t result = B_DEV_INVALID_IOCTL;
switch (msg) {
case B_GET_ACCELERANT_SIGNATURE: {
if (user_strlcpy((char*)buf, current_settings.accelerant,
B_FILE_NAME_LENGTH) < B_OK) {
return B_BAD_ADDRESS;
}
result = B_OK;
} break;
case GX00_GET_PRIVATE_DATA: {
gx00_get_private_data gpd;
if (user_memcpy(&gpd, buf, sizeof(gx00_get_private_data)) < B_OK)
return B_BAD_ADDRESS;
if (gpd.magic == GX00_PRIVATE_DATA_MAGIC) {
gpd.shared_info_area = di->shared_area;
result = user_memcpy(buf, &gpd, sizeof(gx00_get_private_data));
}
} break;
case GX00_GET_PCI: {
gx00_get_set_pci gsp;
if (user_memcpy(&gsp, buf, sizeof(gx00_get_set_pci)) < B_OK)
return B_BAD_ADDRESS;
if (gsp.magic == GX00_PRIVATE_DATA_MAGIC) {
pci_info *pcii = &(di->pcii);
gsp.value = get_pci(gsp.offset, gsp.size);
result = user_memcpy(buf, &gsp, sizeof(gx00_get_set_pci));
}
} break;
case GX00_SET_PCI: {
gx00_get_set_pci gsp;
if (user_memcpy(&gsp, buf, sizeof(gx00_get_set_pci)) < B_OK)
return B_BAD_ADDRESS;
if (gsp.magic == GX00_PRIVATE_DATA_MAGIC) {
pci_info *pcii = &(di->pcii);
set_pci(gsp.offset, gsp.size, gsp.value);
result = B_OK;
}
} break;
case GX00_DEVICE_NAME: {
gx00_device_name dn;
if (user_memcpy(&dn, buf, sizeof(gx00_device_name)) < B_OK)
return B_BAD_ADDRESS;
if (dn.magic == GX00_PRIVATE_DATA_MAGIC) {
if (user_strlcpy(dn.name, di->name, B_OS_NAME_LENGTH) < B_OK)
return B_BAD_ADDRESS;
result = B_OK;
}
} break;
case GX00_RUN_INTERRUPTS: {
gx00_set_bool_state ri;
if (user_memcpy(&ri, buf, sizeof(gx00_set_bool_state)) < B_OK)
return B_BAD_ADDRESS;
if (ri.magic == GX00_PRIVATE_DATA_MAGIC) {
vuint32 *regs = di->regs;
if (ri.do_it) {
enable_vbi(regs);
} else {
disable_vbi(regs);
}
result = B_OK;
}
} break;
}
return result;
}