/** * thc_acpi_get_property - Query device ACPI parameter * * @adev: point to ACPI device * @guid: ACPI method's guid * @rev: ACPI method's revision * @func: ACPI method's function number * @type: ACPI parameter's data type * @prop_buf: point to return buffer * * This is a helper function for device to query its ACPI parameters. * * Return: 0 if successful or ENODEV on failed.
*/ staticint thc_acpi_get_property(struct acpi_device *adev, const guid_t *guid,
u64 rev, u64 func, acpi_object_type type, void *prop_buf)
{
acpi_handle handle = acpi_device_handle(adev); union acpi_object *obj;
/** * quickspi_get_acpi_resources - Query all quickspi devices' ACPI parameters * * @qsdev: point to quickspi device * * This function gets all quickspi devices' ACPI resource. * * Return: 0 if successful or error code on failed.
*/ staticint quickspi_get_acpi_resources(struct quickspi_device *qsdev)
{ struct acpi_device *adev = ACPI_COMPANION(qsdev->dev); int ret = -EINVAL;
if (!adev) {
dev_err(qsdev->dev, "no valid ACPI companion\n"); return ret;
}
qsdev->acpi_dev = adev;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_INPUT_REP_HDR_ADDR,
ACPI_TYPE_INTEGER,
&qsdev->input_report_hdr_addr); if (ret) return ret;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_INPUT_REP_BDY_ADDR,
ACPI_TYPE_INTEGER,
&qsdev->input_report_bdy_addr); if (ret) return ret;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_OUTPUT_REP_ADDR,
ACPI_TYPE_INTEGER,
&qsdev->output_report_addr); if (ret) return ret;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_READ_OPCODE,
ACPI_TYPE_BUFFER,
&qsdev->spi_read_opcode); if (ret) return ret;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_WRITE_OPCODE,
ACPI_TYPE_BUFFER,
&qsdev->spi_write_opcode); if (ret) return ret;
ret = thc_acpi_get_property(adev, &hidspi_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_IO_MODE,
ACPI_TYPE_INTEGER,
&qsdev->spi_read_io_mode); if (ret) return ret;
ret = thc_acpi_get_property(adev, &thc_platform_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_ACTIVE_LTR,
ACPI_TYPE_INTEGER,
&qsdev->active_ltr_val); if (ret) return ret;
ret = thc_acpi_get_property(adev, &thc_platform_guid,
ACPI_QUICKSPI_REVISION_NUM,
ACPI_QUICKSPI_FUNC_NUM_LP_LTR,
ACPI_TYPE_INTEGER,
&qsdev->low_power_ltr_val); if (ret) return ret;
return 0;
}
/** * quickspi_irq_quick_handler - The ISR of the quickspi driver * * @irq: The irq number * @dev_id: pointer to the device structure * * Return: IRQ_WAKE_THREAD if further process needed.
*/ static irqreturn_t quickspi_irq_quick_handler(int irq, void *dev_id)
{ struct quickspi_device *qsdev = dev_id;
if (qsdev->state == QUICKSPI_DISABLED) return IRQ_HANDLED;
/* Disable THC interrupt before current interrupt be handled */
thc_interrupt_enable(qsdev->thc_hw, false);
return IRQ_WAKE_THREAD;
}
/** * try_recover - Try to recovery THC and Device * @qsdev: pointer to quickspi device * * This function is a error handler, called when fatal error happens. * It try to reset Touch Device and re-configure THC to recovery * transferring between Device and THC. * * Return: 0 if successful or error code on failed.
*/ staticint try_recover(struct quickspi_device *qsdev)
{ int ret;
ret = reset_tic(qsdev); if (ret) {
dev_err(qsdev->dev, "Reset touch device failed, ret = %d\n", ret); return ret;
}
thc_dma_unconfigure(qsdev->thc_hw);
ret = thc_dma_configure(qsdev->thc_hw); if (ret) {
dev_err(qsdev->dev, "Re-configure THC DMA failed, ret = %d\n", ret); return ret;
}
return 0;
}
/** * quickspi_irq_thread_handler - IRQ thread handler of quickspi driver * * @irq: The IRQ number * @dev_id: pointer to the quickspi device structure * * Return: IRQ_HANDLED to finish this handler.
*/ static irqreturn_t quickspi_irq_thread_handler(int irq, void *dev_id)
{ struct quickspi_device *qsdev = dev_id;
size_t input_len; int read_finished = 0; int err_recover = 0; int int_mask; int ret;
if (qsdev->state == QUICKSPI_DISABLED) return IRQ_HANDLED;
ret = pm_runtime_resume_and_get(qsdev->dev); if (ret) return IRQ_HANDLED;
/* thc hw init */
qsdev->thc_hw = thc_dev_init(qsdev->dev, qsdev->mem_addr); if (IS_ERR(qsdev->thc_hw)) {
ret = PTR_ERR(qsdev->thc_hw);
dev_err(dev, "Failed to initialize THC device context, ret = %d.\n", ret); return ERR_PTR(ret);
}
ret = thc_interrupt_quiesce(qsdev->thc_hw, true); if (ret) return ERR_PTR(ret);
ret = thc_port_select(qsdev->thc_hw, THC_PORT_TYPE_SPI); if (ret) {
dev_err(dev, "Failed to select THC port, ret = %d.\n", ret); return ERR_PTR(ret);
}
ret = quickspi_get_acpi_resources(qsdev); if (ret) {
dev_err(dev, "Get ACPI resources failed, ret = %d\n", ret); return ERR_PTR(ret);
}
/** * quickspi_dma_init - Configure THC DMA for quickspi device * @qsdev: pointer to the quickspi device structure * * This function uses TIC's parameters(such as max input length, max output * length) to allocate THC DMA buffers and configure THC DMA engines. * * Return: 0 if successful or error code on failed.
*/ staticint quickspi_dma_init(struct quickspi_device *qsdev)
{ int ret;
ret = thc_dma_set_max_packet_sizes(qsdev->thc_hw, 0,
le16_to_cpu(qsdev->dev_desc.max_input_len),
le16_to_cpu(qsdev->dev_desc.max_output_len),
0); if (ret) return ret;
ret = thc_dma_allocate(qsdev->thc_hw); if (ret) {
dev_err(qsdev->dev, "Allocate THC DMA buffer failed, ret = %d\n", ret); return ret;
}
/* Enable RxDMA */
ret = thc_dma_configure(qsdev->thc_hw); if (ret) {
dev_err(qsdev->dev, "Configure THC DMA failed, ret = %d\n", ret);
thc_dma_unconfigure(qsdev->thc_hw);
thc_dma_release(qsdev->thc_hw); return ret;
}
return ret;
}
/** * quickspi_dma_deinit - Release THC DMA for quickspi device * @qsdev: pointer to the quickspi device structure * * Stop THC DMA engines and release all DMA buffers. *
*/ staticvoid quickspi_dma_deinit(struct quickspi_device *qsdev)
{
thc_dma_unconfigure(qsdev->thc_hw);
thc_dma_release(qsdev->thc_hw);
}
/** * quickspi_alloc_report_buf - Alloc report buffers * @qsdev: pointer to the quickspi device structure * * Allocate report descriptor buffer, it will be used for restore TIC HID * report descriptor. * * Allocate input report buffer, it will be used for receive HID input report * data from TIC. * * Allocate output report buffer, it will be used for store HID output report, * such as set feature. * * Return: 0 if successful or error code on failed.
*/ staticint quickspi_alloc_report_buf(struct quickspi_device *qsdev)
{
size_t max_report_len;
size_t max_input_len;
qsdev->report_descriptor = devm_kzalloc(qsdev->dev,
le16_to_cpu(qsdev->dev_desc.rep_desc_len),
GFP_KERNEL); if (!qsdev->report_descriptor) return -ENOMEM;
qsdev->report_buf = devm_kzalloc(qsdev->dev, max_report_len, GFP_KERNEL); if (!qsdev->report_buf) return -ENOMEM;
return 0;
}
/* * quickspi_probe: Quickspi driver probe function * * @pdev: point to pci device * @id: point to pci_device_id structure * * This function initializes THC and HIDSPI device, the flow is: * - do THC pci device initialization * - query HIDSPI ACPI parameters * - configure THC to HIDSPI mode * - go through HIDSPI enumeration flow * |- reset HIDSPI device * |- read device descriptor * - enable THC interrupt and DMA * - read report descriptor * - register HID device * - enable runtime power management * * Return 0 if success or error code on failure.
*/ staticint quickspi_probe(struct pci_dev *pdev, conststruct pci_device_id *id)
{ struct quickspi_device *qsdev; void __iomem *mem_addr; int ret;
ret = pcim_enable_device(pdev); if (ret) {
dev_err(&pdev->dev, "Failed to enable PCI device, ret = %d.\n", ret); return ret;
}
pci_set_master(pdev);
mem_addr = pcim_iomap_region(pdev, 0, KBUILD_MODNAME);
ret = PTR_ERR_OR_ZERO(mem_addr); if (ret) {
dev_err(&pdev->dev, "Failed to get PCI regions, ret = %d.\n", ret); goto disable_pci_device;
}
ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); if (ret) {
ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)); if (ret) {
dev_err(&pdev->dev, "No usable DMA configuration %d\n", ret); goto disable_pci_device;
}
}
ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_ALL_TYPES); if (ret < 0) {
dev_err(&pdev->dev, "Failed to allocate IRQ vectors. ret = %d\n", ret); goto disable_pci_device;
}
pdev->irq = pci_irq_vector(pdev, 0);
qsdev = quickspi_dev_init(pdev, mem_addr, id); if (IS_ERR(qsdev)) {
dev_err(&pdev->dev, "QuickSPI device init failed\n");
ret = PTR_ERR(qsdev); goto disable_pci_device;
}
pci_set_drvdata(pdev, qsdev);
ret = devm_request_threaded_irq(&pdev->dev, pdev->irq,
quickspi_irq_quick_handler,
quickspi_irq_thread_handler,
IRQF_ONESHOT, KBUILD_MODNAME,
qsdev); if (ret) {
dev_err(&pdev->dev, "Failed to request threaded IRQ, irq = %d.\n", pdev->irq); goto dev_deinit;
}
ret = reset_tic(qsdev); if (ret) {
dev_err(&pdev->dev, "Reset Touch Device failed, ret = %d\n", ret); goto dev_deinit;
}
ret = quickspi_alloc_report_buf(qsdev); if (ret) {
dev_err(&pdev->dev, "Alloc report buffers failed, ret= %d\n", ret); goto dev_deinit;
}
ret = quickspi_dma_init(qsdev); if (ret) {
dev_err(&pdev->dev, "Setup THC DMA failed, ret= %d\n", ret); goto dev_deinit;
}
ret = quickspi_get_report_descriptor(qsdev); if (ret) {
dev_err(&pdev->dev, "Get report descriptor failed, ret = %d\n", ret); goto dma_deinit;
}
ret = quickspi_hid_probe(qsdev); if (ret) {
dev_err(&pdev->dev, "Failed to register HID device, ret = %d\n", ret); goto dma_deinit;
}
/** * quickspi_remove - Device Removal Routine * * @pdev: PCI device structure * * This is called by the PCI subsystem to alert the driver * that it should release a PCI device.
*/ staticvoid quickspi_remove(struct pci_dev *pdev)
{ struct quickspi_device *qsdev;
qsdev = pci_get_drvdata(pdev); if (!qsdev) return;
/** * quickspi_shutdown - Device Shutdown Routine * * @pdev: PCI device structure * * This is called from the reboot notifier * it's a simplified version of remove so we go down * faster.
*/ staticvoid quickspi_shutdown(struct pci_dev *pdev)
{ struct quickspi_device *qsdev;
qsdev = pci_get_drvdata(pdev); if (!qsdev) return;
/* Must stop DMA before reboot to avoid DMA entering into unknown state */
quickspi_dma_deinit(qsdev);
Die Informationen auf dieser Webseite wurden
nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit,
noch Qualität der bereit gestellten Informationen zugesichert.
Bemerkung:
Die farbliche Syntaxdarstellung und die Messung sind noch experimentell.