/* * \brief platform device component * \author Norman Feske * \date 2008-01-28 */ /* * Copyright (C) 2008-2015 Genode Labs GmbH * * This file is part of the Genode OS framework, which is distributed * under the terms of the GNU General Public License version 2. */ #pragma once /* base */ #include #include #include #include #include /* os */ #include /* local */ #include "pci_device_config.h" #include "irq.h" namespace Platform { class Device_component; class Session_component; } class Platform::Device_component : public Genode::Rpc_object, public Genode::List::Element { private: Device_config _device_config; Genode::addr_t _config_space; Config_access _config_access; Genode::Rpc_entrypoint &_ep; Platform::Session_component &_session; unsigned short _irq_line; Irq_session_component *_irq_session = nullptr; Genode::Constructible _io_mem_config_extended; class Io_mem : public Genode::Io_mem_connection, public Genode::List::Element { public: Io_mem (Genode::addr_t base, Genode::size_t size, bool wc) : Genode::Io_mem_connection(base, size, wc) { } }; enum { IO_BLOCK_SIZE = sizeof(Genode::Io_port_connection) * Device::NUM_RESOURCES + 32 + 8 * sizeof(void *), IO_MEM_SIZE = sizeof(Io_mem) * Device::NUM_RESOURCES + 32 + 8 * sizeof(void *), PCI_CMD_REG = 0x4, PCI_CMD_DMA = 0x4, PCI_IRQ_LINE = 0x3c, PCI_IRQ_PIN = 0x3d, CAP_MSI_64 = 0x80, CAP_MASK = 0x100, MSI_ENABLED = 0x1 }; Genode::Tslab _slab_ioport; char _slab_ioport_block_data[IO_BLOCK_SIZE]; Genode::Tslab _slab_iomem; char _slab_iomem_block_data[IO_MEM_SIZE]; char _mem_irq_component[sizeof(Irq_session_component)]; Genode::Io_port_connection *_io_port_conn [Device::NUM_RESOURCES]; Genode::List _io_mem [Device::NUM_RESOURCES]; struct Status : Genode::Register<8> { struct Capabilities : Bitfield<4,1> { }; inline static access_t read(Genode::uint8_t t) { return t; }; }; /** * Read out msi capabilities of the device. */ Genode::uint16_t _msi_cap() { enum { PCI_STATUS = 0x6, PCI_CAP_OFFSET = 0x34, CAP_MSI = 0x5 }; Status::access_t status = Status::read(_device_config.read(&_config_access, PCI_STATUS, Platform::Device::ACCESS_16BIT)); if (!Status::Capabilities::get(status)) return 0; Genode::uint8_t cap = _device_config.read(&_config_access, PCI_CAP_OFFSET, Platform::Device::ACCESS_8BIT); for (Genode::uint16_t val = 0; cap; cap = val >> 8) { val = _device_config.read(&_config_access, cap, Platform::Device::ACCESS_16BIT); if ((val & 0xff) != CAP_MSI) continue; return cap; } return 0; } /** * Disable MSI if already enabled. */ unsigned _configure_irq(unsigned irq) { using Genode::uint16_t; using Genode::uint8_t; uint8_t pin = _device_config.read(&_config_access, PCI_IRQ_PIN, Platform::Device::ACCESS_8BIT); if (!pin) return Irq_session_component::INVALID_IRQ; /* lookup rewrite information as provided by acpi table */ uint16_t irq_r = Irq_routing::rewrite(_device_config.bus_number(), _device_config.device_number(), _device_config.function_number(), pin); if (irq_r) { Genode::log(_device_config, " adjust IRQ as reported by ACPI: ", irq, " -> ", irq_r); _irq_line = irq = irq_r; } uint16_t cap = _msi_cap(); if (!cap) return irq; uint16_t msi = _device_config.read(&_config_access, cap + 2, Platform::Device::ACCESS_16BIT); if (msi & MSI_ENABLED) /* disable MSI */ _device_config.write(&_config_access, cap + 2, msi ^ MSI_ENABLED, Platform::Device::ACCESS_8BIT); return irq; } /** * Disable bus master dma if already enabled. */ void _disable_bus_master_dma() { /* * Disabling a bridge may make the devices behind non-functional, * as we have no driver which will switch it on again */ if (_device_config.pci_bridge()) return; unsigned cmd = _device_config.read(&_config_access, PCI_CMD_REG, Platform::Device::ACCESS_16BIT); if (cmd & PCI_CMD_DMA) _device_config.write(&_config_access, PCI_CMD_REG, cmd ^ PCI_CMD_DMA, Platform::Device::ACCESS_16BIT); } public: /** * Constructor */ Device_component(Device_config device_config, Genode::addr_t addr, Genode::Rpc_entrypoint &ep, Platform::Session_component &session, Genode::Allocator &md_alloc) : _device_config(device_config), _config_space(addr), _ep(ep), _session(session), _irq_line(_device_config.read(&_config_access, PCI_IRQ_LINE, Platform::Device::ACCESS_8BIT)), _slab_ioport(&md_alloc, &_slab_ioport_block_data), _slab_iomem(&md_alloc, &_slab_iomem_block_data) { for (unsigned i = 0; i < Device::NUM_RESOURCES; i++) { _io_port_conn[i] = nullptr; } _disable_bus_master_dma(); } /** * Constructor for non PCI devices */ Device_component(Genode::Rpc_entrypoint &ep, Platform::Session_component &session, unsigned irq) : _config_space(~0UL), _ep(ep), _session(session), _irq_line(irq), _slab_ioport(nullptr, &_slab_ioport_block_data), _slab_iomem(nullptr, &_slab_iomem_block_data) { for (unsigned i = 0; i < Device::NUM_RESOURCES; i++) _io_port_conn[i] = nullptr; } /** * De-constructor */ ~Device_component() { if (_irq_session) { _ep.dissolve(_irq_session); _irq_session->~Irq_session(); } for (unsigned i = 0; i < Device::NUM_RESOURCES; i++) { if (_io_port_conn[i]) Genode::destroy(_slab_ioport, _io_port_conn[i]); while (Io_mem * io_mem = _io_mem[i].first()) { _io_mem[i].remove(io_mem); Genode::destroy(_slab_iomem, io_mem); } } if (_device_config.valid()) _disable_bus_master_dma(); } /**************************************** ** Methods used solely by pci session ** ****************************************/ Device_config config() { return _device_config; } Genode::Io_mem_dataspace_capability get_config_space() { if (_config_space == ~0UL) return Genode::Io_mem_dataspace_capability(); if (!_io_mem_config_extended.constructed()) { try { _io_mem_config_extended.construct(_config_space, 0x1000); } catch (...) { _config_space = ~0UL; } } if (!_io_mem_config_extended.constructed()) return Genode::Io_mem_dataspace_capability(); return _io_mem_config_extended->dataspace(); } /************************** ** PCI-device interface ** **************************/ void bus_address(unsigned char *bus, unsigned char *dev, unsigned char *fn) override { *bus = _device_config.bus_number(); *dev = _device_config.device_number(); *fn = _device_config.function_number(); } unsigned short vendor_id() override { return _device_config.vendor_id(); } unsigned short device_id() override { return _device_config.device_id(); } unsigned class_code() override { return _device_config.class_code(); } Resource resource(int resource_id) override { /* return invalid resource if device is invalid */ if (!_device_config.valid()) return Resource(0, 0); return _device_config.resource(resource_id); } unsigned config_read(unsigned char address, Access_size size) override { return _device_config.read(&_config_access, address, size, _device_config.DONT_TRACK_ACCESS); } void config_write(unsigned char address, unsigned value, Access_size size) override; Genode::Irq_session_capability irq(Genode::uint8_t) override; Genode::Io_port_session_capability io_port(Genode::uint8_t) override; Genode::Io_mem_session_capability io_mem(Genode::uint8_t, Genode::Cache_attribute, Genode::addr_t, Genode::size_t) override; };