Initial work for a driver supporting the pre-AHCI SATA controllers. Currently
implemented: VIA & ALI. nForce is on the TODO list ;) git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@21894 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Ithamar R. Adema
parent
6ad9efd671
commit
fba47bd728
8
src/add-ons/kernel/busses/ide/legacy_sata/Jamfile
Normal file
8
src/add-ons/kernel/busses/ide/legacy_sata/Jamfile
Normal file
@ -0,0 +1,8 @@
|
|||||||
|
SubDir HAIKU_TOP src add-ons kernel busses ide legacy_sata ;
|
||||||
|
|
||||||
|
UsePrivateHeaders kernel ;
|
||||||
|
|
||||||
|
KernelAddon legacy_sata :
|
||||||
|
legacy_sata.c
|
||||||
|
;
|
||||||
|
|
||||||
389
src/add-ons/kernel/busses/ide/legacy_sata/legacy_sata.c
Normal file
389
src/add-ons/kernel/busses/ide/legacy_sata/legacy_sata.c
Normal file
@ -0,0 +1,389 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2007, Ithamar R. Adema. All rights reserved.
|
||||||
|
* Distributed under the terms of the MIT License.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <KernelExport.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <device_manager.h>
|
||||||
|
#include <bus/IDE.h>
|
||||||
|
#include <bus/ide/ide_adapter.h>
|
||||||
|
#include <block_io.h>
|
||||||
|
|
||||||
|
|
||||||
|
#define DRIVER_PRETTY_NAME "Legacy SATA"
|
||||||
|
#define CONTROLLER_NAME DRIVER_PRETTY_NAME
|
||||||
|
#define CONTROLLER_MODULE_NAME "busses/ide/legacy_sata/device_v1"
|
||||||
|
#define CHANNEL_MODULE_NAME "busses/ide/legacy_sata/channel/v1"
|
||||||
|
|
||||||
|
#define TRACE(a...) dprintf(DRIVER_PRETTY_NAME ": " a)
|
||||||
|
#define FLOW(a...) dprintf(DRIVER_PRETTY_NAME ": " a)
|
||||||
|
|
||||||
|
#define PCI_vendor_VIA 0x1106
|
||||||
|
#define PCI_device_VIA6420 0x3149
|
||||||
|
#define PCI_device_VIA6421 0x3249
|
||||||
|
#define PCI_device_VIA8237A 0x0591
|
||||||
|
|
||||||
|
#define PCI_vendor_ALI 0x10b9
|
||||||
|
#define PCI_device_ALI5289 0x5289
|
||||||
|
#define PCI_device_ALI5287 0x5287
|
||||||
|
#define PCI_device_ALI5281 0x5281
|
||||||
|
|
||||||
|
#define ID(v,d) (((v)<< 16) | (d))
|
||||||
|
|
||||||
|
/* XXX: To be moved to PCI.h */
|
||||||
|
#define PCI_command_interrupt 0x400
|
||||||
|
|
||||||
|
static ide_for_controller_interface* ide;
|
||||||
|
static ide_adapter_interface* ide_adapter;
|
||||||
|
static device_manager_info* dm;
|
||||||
|
|
||||||
|
static float
|
||||||
|
controller_supports(device_node_handle parent, bool *_noConnection)
|
||||||
|
{
|
||||||
|
uint16 vendor_id;
|
||||||
|
uint16 device_id;
|
||||||
|
status_t res;
|
||||||
|
char *bus;
|
||||||
|
|
||||||
|
// get the bus (should be PCI)
|
||||||
|
if (dm->get_attr_string(parent, B_DRIVER_BUS, &bus, false) != B_OK)
|
||||||
|
return B_ERROR;
|
||||||
|
if (strcmp(bus, "pci") != 0) {
|
||||||
|
free(bus);
|
||||||
|
return B_ERROR;
|
||||||
|
}
|
||||||
|
free(bus);
|
||||||
|
|
||||||
|
// get vendor and device ID
|
||||||
|
if ((res=dm->get_attr_uint16(parent, PCI_DEVICE_VENDOR_ID_ITEM, &vendor_id, false)) != B_OK
|
||||||
|
|| (res=dm->get_attr_uint16(parent, PCI_DEVICE_DEVICE_ID_ITEM, &device_id, false)) != B_OK) {
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (ID(vendor_id, device_id)) {
|
||||||
|
/* VIA SATA chipsets */
|
||||||
|
case ID(PCI_vendor_VIA, PCI_device_VIA6420):
|
||||||
|
case ID(PCI_vendor_VIA, PCI_device_VIA6421):
|
||||||
|
case ID(PCI_vendor_VIA, PCI_device_VIA8237A):
|
||||||
|
break;
|
||||||
|
|
||||||
|
/* ALI SATA chipsets */
|
||||||
|
case ID(PCI_vendor_ALI, PCI_device_ALI5281):
|
||||||
|
case ID(PCI_vendor_ALI, PCI_device_ALI5287):
|
||||||
|
case ID(PCI_vendor_ALI, PCI_device_ALI5289):
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return 0.0f;
|
||||||
|
}
|
||||||
|
|
||||||
|
TRACE("controller found! vendor 0x%04x, device 0x%04x\n", vendor_id, device_id);
|
||||||
|
|
||||||
|
return 0.8f;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
controller_probe(device_node_handle parent)
|
||||||
|
{
|
||||||
|
device_node_handle controller_node;
|
||||||
|
device_node_handle channels[2];
|
||||||
|
uint16 command_block_base[2];
|
||||||
|
uint16 control_block_base[2];
|
||||||
|
pci_device_module_info *pci;
|
||||||
|
uint8 num_channels = 2;
|
||||||
|
uint32 bus_master_base;
|
||||||
|
pci_device device;
|
||||||
|
uint16 device_id;
|
||||||
|
uint16 vendor_id;
|
||||||
|
uint8 int_num;
|
||||||
|
status_t res;
|
||||||
|
|
||||||
|
TRACE("controller_probe\n");
|
||||||
|
|
||||||
|
if ((res=dm->init_driver(parent, NULL, (driver_module_info **)&pci, (void **)&device)) != B_OK)
|
||||||
|
return res;
|
||||||
|
|
||||||
|
device_id = pci->read_pci_config(device, PCI_device_id, 2);
|
||||||
|
vendor_id = pci->read_pci_config(device, PCI_vendor_id, 2);
|
||||||
|
int_num = pci->read_pci_config(device, PCI_interrupt_line, 1);
|
||||||
|
bus_master_base = pci->read_pci_config(device, PCI_base_registers + 16, 4);
|
||||||
|
|
||||||
|
/* enable PCI interrupt */
|
||||||
|
pci->write_pci_config(device, PCI_command,
|
||||||
|
pci->read_pci_config(device, PCI_command, 2) & ~PCI_command_interrupt, 2);
|
||||||
|
|
||||||
|
|
||||||
|
switch (ID(vendor_id, device_id)) {
|
||||||
|
case ID(PCI_vendor_VIA,PCI_device_VIA6421):
|
||||||
|
/* newer SATA chips has resources in one BAR for each channel */
|
||||||
|
num_channels = 4;
|
||||||
|
command_block_base[0] = pci->read_pci_config(device, PCI_base_registers + 0, 4 );
|
||||||
|
control_block_base[0] = command_block_base[0] + 8;
|
||||||
|
command_block_base[1] = pci->read_pci_config(device, PCI_base_registers + 4, 4);
|
||||||
|
control_block_base[1] = command_block_base[1] + 8;
|
||||||
|
command_block_base[2] = pci->read_pci_config(device, PCI_base_registers + 8, 4 );
|
||||||
|
control_block_base[2] = command_block_base[2] + 8;
|
||||||
|
command_block_base[3] = pci->read_pci_config(device, PCI_base_registers + 12, 4);
|
||||||
|
control_block_base[3] = command_block_base[3] + 8;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case ID(PCI_vendor_ALI, PCI_device_ALI5287):
|
||||||
|
num_channels = 4;
|
||||||
|
command_block_base[3] = pci->read_pci_config(device, PCI_base_registers + 0, 4 ) + 8;
|
||||||
|
control_block_base[3] = pci->read_pci_config(device, PCI_base_registers + 4, 4) + 4;
|
||||||
|
command_block_base[4] = pci->read_pci_config(device, PCI_base_registers + 8, 4) + 8;
|
||||||
|
control_block_base[4] = pci->read_pci_config(device, PCI_base_registers + 12, 4) + 4;
|
||||||
|
/* Intentional fall-through */
|
||||||
|
|
||||||
|
default:
|
||||||
|
/* Default PCI assigments */
|
||||||
|
command_block_base[0] = pci->read_pci_config(device, PCI_base_registers + 0, 4 );
|
||||||
|
control_block_base[0] = pci->read_pci_config(device, PCI_base_registers + 4, 4);
|
||||||
|
command_block_base[1] = pci->read_pci_config(device, PCI_base_registers + 8, 4);
|
||||||
|
control_block_base[1] = pci->read_pci_config(device, PCI_base_registers + 12, 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
res = ide_adapter->detect_controller(pci, device, parent, bus_master_base,
|
||||||
|
CONTROLLER_MODULE_NAME, "" /* XXX: unused: controller_driver_type*/, CONTROLLER_NAME, true,
|
||||||
|
true, 1, 0xffff, 0x10000, &controller_node);
|
||||||
|
// don't register if controller is already registered!
|
||||||
|
// (happens during rescan; registering new channels would kick out old channels)
|
||||||
|
if (res != B_OK)
|
||||||
|
goto err;
|
||||||
|
if (controller_node == NULL) {
|
||||||
|
res = B_IO_ERROR;
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
|
||||||
|
// ignore errors during registration of channels - could be a simple rescan collision
|
||||||
|
ide_adapter->detect_channel(pci, device, controller_node, CHANNEL_MODULE_NAME,
|
||||||
|
true, command_block_base[0], control_block_base[0], bus_master_base,
|
||||||
|
int_num, true, "Primary Channel", &channels[0], false);
|
||||||
|
|
||||||
|
ide_adapter->detect_channel(pci, device, controller_node, CHANNEL_MODULE_NAME,
|
||||||
|
true, command_block_base[1], control_block_base[1], bus_master_base,
|
||||||
|
int_num, false, "Secondary Channel", &channels[1], false);
|
||||||
|
|
||||||
|
if (num_channels == 4) {
|
||||||
|
ide_adapter->detect_channel(pci, device, controller_node, CHANNEL_MODULE_NAME,
|
||||||
|
true, command_block_base[2], control_block_base[2], bus_master_base,
|
||||||
|
int_num, true, "Tertiary Channel", &channels[2], false);
|
||||||
|
|
||||||
|
ide_adapter->detect_channel(pci, device, controller_node, CHANNEL_MODULE_NAME,
|
||||||
|
true, command_block_base[3], control_block_base[3], bus_master_base,
|
||||||
|
int_num, false, "Quaternary Channel", &channels[3], false);
|
||||||
|
}
|
||||||
|
|
||||||
|
dm->uninit_driver(parent);
|
||||||
|
|
||||||
|
TRACE("controller_probe success\n");
|
||||||
|
return B_OK;
|
||||||
|
|
||||||
|
err:
|
||||||
|
dm->uninit_driver(parent);
|
||||||
|
TRACE("controller_probe failed (%s)\n", strerror(res));
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
controller_init(device_node_handle node, void *user_cookie, void **controller_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->init_controller(
|
||||||
|
node,user_cookie,
|
||||||
|
(ide_adapter_controller_info**)controller_cookie,
|
||||||
|
sizeof(ide_adapter_controller_info));
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
controller_uninit(void *controller_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->uninit_controller(controller_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
controller_removed(device_node_handle node, void *controller_cookie)
|
||||||
|
{
|
||||||
|
ide_adapter->controller_removed(
|
||||||
|
node,
|
||||||
|
(ide_adapter_controller_info*)controller_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
controller_get_paths(const char ***_bus, const char ***_device)
|
||||||
|
{
|
||||||
|
static const char *kBus[] = { "pci", NULL };
|
||||||
|
static const char *kDevice[] = { "drivers/dev/disk/sata", NULL };
|
||||||
|
|
||||||
|
*_bus = kBus;
|
||||||
|
*_device = kDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
channel_init(device_node_handle node, void *user_cookie, void **channel_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->init_channel(
|
||||||
|
node,
|
||||||
|
user_cookie,
|
||||||
|
(ide_adapter_channel_info**)channel_cookie,
|
||||||
|
sizeof(ide_adapter_channel_info),
|
||||||
|
ide_adapter->inthand);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
channel_uninit(void *channel_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->uninit_channel(channel_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
channel_removed(device_node_handle node, void *channel_cookie)
|
||||||
|
{
|
||||||
|
ide_adapter->channel_removed(node,channel_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
task_file_write(void *channel_cookie, ide_task_file *tf, ide_reg_mask mask)
|
||||||
|
{
|
||||||
|
return ide_adapter->write_command_block_regs(channel_cookie,tf,mask);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
task_file_read(void *channel_cookie, ide_task_file *tf, ide_reg_mask mask)
|
||||||
|
{
|
||||||
|
return ide_adapter->read_command_block_regs(channel_cookie,tf,mask);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static uint8
|
||||||
|
altstatus_read(void *channel_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->get_altstatus(channel_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
device_control_write(void *channel_cookie, uint8 val)
|
||||||
|
{
|
||||||
|
return ide_adapter->write_device_control(channel_cookie,val);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
pio_write(void *channel_cookie, uint16 *data, int count, bool force_16bit)
|
||||||
|
{
|
||||||
|
return ide_adapter->write_pio(channel_cookie,data,count,force_16bit);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
pio_read(void *channel_cookie, uint16 *data, int count, bool force_16bit)
|
||||||
|
{
|
||||||
|
return ide_adapter->read_pio(channel_cookie,data,count,force_16bit);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
dma_prepare(void *channel_cookie, const physical_entry *sg_list, size_t sg_list_count, bool write)
|
||||||
|
{
|
||||||
|
return ide_adapter->prepare_dma(channel_cookie,sg_list,sg_list_count,write);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
dma_start(void *channel_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->start_dma(channel_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
dma_finish(void *channel_cookie)
|
||||||
|
{
|
||||||
|
return ide_adapter->finish_dma(channel_cookie);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static status_t
|
||||||
|
std_ops(int32 op, ...)
|
||||||
|
{
|
||||||
|
switch (op) {
|
||||||
|
case B_MODULE_INIT:
|
||||||
|
return B_OK;
|
||||||
|
case B_MODULE_UNINIT:
|
||||||
|
return B_OK;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return B_ERROR;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
module_dependency module_dependencies[] = {
|
||||||
|
{ IDE_FOR_CONTROLLER_MODULE_NAME, (module_info **)&ide },
|
||||||
|
{ B_DEVICE_MANAGER_MODULE_NAME, (module_info **)&dm },
|
||||||
|
{ IDE_ADAPTER_MODULE_NAME, (module_info **)&ide_adapter },
|
||||||
|
{}
|
||||||
|
};
|
||||||
|
|
||||||
|
static ide_controller_interface channel_interface = {
|
||||||
|
{
|
||||||
|
{
|
||||||
|
CHANNEL_MODULE_NAME,
|
||||||
|
0,
|
||||||
|
std_ops
|
||||||
|
},
|
||||||
|
|
||||||
|
.supports_device = NULL,
|
||||||
|
.register_device = NULL,
|
||||||
|
.init_driver = channel_init,
|
||||||
|
.uninit_driver = channel_uninit,
|
||||||
|
.device_removed = channel_removed,
|
||||||
|
.device_cleanup = NULL,
|
||||||
|
.get_supported_paths = NULL,
|
||||||
|
},
|
||||||
|
|
||||||
|
.write_command_block_regs = task_file_write,
|
||||||
|
.read_command_block_regs = task_file_read,
|
||||||
|
.get_altstatus = altstatus_read,
|
||||||
|
.write_device_control = device_control_write,
|
||||||
|
.write_pio = pio_write,
|
||||||
|
.read_pio = pio_read,
|
||||||
|
.prepare_dma = dma_prepare,
|
||||||
|
.start_dma = dma_start,
|
||||||
|
.finish_dma = dma_finish,
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
static driver_module_info controller_interface = {
|
||||||
|
{
|
||||||
|
CONTROLLER_MODULE_NAME,
|
||||||
|
0,
|
||||||
|
std_ops
|
||||||
|
},
|
||||||
|
|
||||||
|
.supports_device = controller_supports,
|
||||||
|
.register_device = controller_probe,
|
||||||
|
.init_driver = controller_init,
|
||||||
|
.uninit_driver = controller_uninit,
|
||||||
|
.device_removed = controller_removed,
|
||||||
|
.device_cleanup = NULL,
|
||||||
|
.get_supported_paths = controller_get_paths,
|
||||||
|
};
|
||||||
|
|
||||||
|
module_info *modules[] = {
|
||||||
|
(module_info *)&controller_interface,
|
||||||
|
(module_info *)&channel_interface,
|
||||||
|
NULL
|
||||||
|
};
|
||||||
Loading…
Reference in New Issue
Block a user