During S4 retore flow, quickspi device was resetted by driver and state
was changed to RESETTED. It is needed to be change to ENABLED state
after S4 re-initialization finished, otherwise, device will run in wrong
state and HID input data will be dropped.
Signed-off-by: Even Xu <even.xu@intel.com>
Fixes: 6912aaf3fd
("HID: intel-thc-hid: intel-quickspi: Add PM implementation")
Signed-off-by: Jiri Kosina <jkosina@suse.com>
989 lines
24 KiB
C
989 lines
24 KiB
C
/* SPDX-License-Identifier: GPL-2.0 */
|
|
/* Copyright (c) 2024 Intel Corporation */
|
|
|
|
#include <linux/acpi.h>
|
|
#include <linux/bitfield.h>
|
|
#include <linux/device.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/err.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/irqreturn.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
#include "intel-thc-dev.h"
|
|
#include "intel-thc-hw.h"
|
|
|
|
#include "quickspi-dev.h"
|
|
#include "quickspi-hid.h"
|
|
#include "quickspi-protocol.h"
|
|
|
|
struct quickspi_driver_data mtl = {
|
|
.max_packet_size_value = MAX_PACKET_SIZE_VALUE_MTL,
|
|
};
|
|
|
|
struct quickspi_driver_data lnl = {
|
|
.max_packet_size_value = MAX_PACKET_SIZE_VALUE_LNL,
|
|
};
|
|
|
|
struct quickspi_driver_data ptl = {
|
|
.max_packet_size_value = MAX_PACKET_SIZE_VALUE_LNL,
|
|
};
|
|
|
|
/* THC QuickSPI ACPI method to get device properties */
|
|
/* HIDSPI Method: {6e2ac436-0fcf-41af-a265-b32a220dcfab} */
|
|
static guid_t hidspi_guid =
|
|
GUID_INIT(0x6e2ac436, 0x0fcf, 0x41af, 0xa2, 0x65, 0xb3, 0x2a,
|
|
0x22, 0x0d, 0xcf, 0xab);
|
|
|
|
/* QuickSpi Method: {300D35b7-ac20-413e-8e9c-92e4dafd0afe} */
|
|
static guid_t thc_quickspi_guid =
|
|
GUID_INIT(0x300d35b7, 0xac20, 0x413e, 0x8e, 0x9c, 0x92, 0xe4,
|
|
0xda, 0xfd, 0x0a, 0xfe);
|
|
|
|
/* Platform Method: {84005682-5b71-41a4-0x8d668130f787a138} */
|
|
static guid_t thc_platform_guid =
|
|
GUID_INIT(0x84005682, 0x5b71, 0x41a4, 0x8d, 0x66, 0x81, 0x30,
|
|
0xf7, 0x87, 0xa1, 0x38);
|
|
|
|
/**
|
|
* 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.
|
|
*/
|
|
static int 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;
|
|
|
|
obj = acpi_evaluate_dsm_typed(handle, guid, rev, func, NULL, type);
|
|
if (!obj) {
|
|
acpi_handle_err(handle,
|
|
"Error _DSM call failed, rev: %llu, func: %llu, type: %u\n",
|
|
rev, func, type);
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (type == ACPI_TYPE_INTEGER)
|
|
*(u32 *)prop_buf = (u32)obj->integer.value;
|
|
else if (type == ACPI_TYPE_BUFFER)
|
|
memcpy(prop_buf, obj->buffer.pointer, obj->buffer.length);
|
|
|
|
ACPI_FREE(obj);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* 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.
|
|
*/
|
|
static int 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;
|
|
|
|
if (qsdev->spi_read_io_mode & SPI_WRITE_IO_MODE)
|
|
qsdev->spi_write_io_mode = FIELD_GET(SPI_IO_MODE_OPCODE, qsdev->spi_read_io_mode);
|
|
else
|
|
qsdev->spi_write_io_mode = THC_SINGLE_IO;
|
|
|
|
qsdev->spi_read_io_mode = FIELD_GET(SPI_IO_MODE_OPCODE, qsdev->spi_read_io_mode);
|
|
|
|
ret = thc_acpi_get_property(adev, &thc_quickspi_guid,
|
|
ACPI_QUICKSPI_REVISION_NUM,
|
|
ACPI_QUICKSPI_FUNC_NUM_CONNECTION_SPEED,
|
|
ACPI_TYPE_INTEGER,
|
|
&qsdev->spi_freq_val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = thc_acpi_get_property(adev, &thc_quickspi_guid,
|
|
ACPI_QUICKSPI_REVISION_NUM,
|
|
ACPI_QUICKSPI_FUNC_NUM_LIMIT_PACKET_SIZE,
|
|
ACPI_TYPE_INTEGER,
|
|
&qsdev->limit_packet_size);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (qsdev->limit_packet_size || !qsdev->driver_data)
|
|
qsdev->spi_packet_size = DEFAULT_MIN_PACKET_SIZE_VALUE;
|
|
else
|
|
qsdev->spi_packet_size = qsdev->driver_data->max_packet_size_value;
|
|
|
|
ret = thc_acpi_get_property(adev, &thc_quickspi_guid,
|
|
ACPI_QUICKSPI_REVISION_NUM,
|
|
ACPI_QUICKSPI_FUNC_NUM_PERFORMANCE_LIMIT,
|
|
ACPI_TYPE_INTEGER,
|
|
&qsdev->performance_limit);
|
|
if (ret)
|
|
return ret;
|
|
|
|
qsdev->performance_limit = FIELD_GET(PERFORMANCE_LIMITATION, qsdev->performance_limit);
|
|
|
|
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.
|
|
*/
|
|
static int 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;
|
|
|
|
int_mask = thc_interrupt_handler(qsdev->thc_hw);
|
|
|
|
if (int_mask & BIT(THC_FATAL_ERR_INT) || int_mask & BIT(THC_TXN_ERR_INT)) {
|
|
err_recover = 1;
|
|
goto end;
|
|
}
|
|
|
|
if (int_mask & BIT(THC_NONDMA_INT)) {
|
|
if (qsdev->state == QUICKSPI_RESETING) {
|
|
qsdev->reset_ack = true;
|
|
wake_up_interruptible(&qsdev->reset_ack_wq);
|
|
} else {
|
|
qsdev->nondma_int_received = true;
|
|
wake_up_interruptible(&qsdev->nondma_int_received_wq);
|
|
}
|
|
}
|
|
|
|
if (int_mask & BIT(THC_RXDMA2_INT)) {
|
|
while (!read_finished) {
|
|
ret = thc_rxdma_read(qsdev->thc_hw, THC_RXDMA2, qsdev->input_buf,
|
|
&input_len, &read_finished);
|
|
if (ret) {
|
|
err_recover = 1;
|
|
goto end;
|
|
}
|
|
|
|
quickspi_handle_input_data(qsdev, input_len);
|
|
}
|
|
}
|
|
|
|
end:
|
|
thc_interrupt_enable(qsdev->thc_hw, true);
|
|
|
|
if (err_recover)
|
|
if (try_recover(qsdev))
|
|
qsdev->state = QUICKSPI_DISABLED;
|
|
|
|
pm_runtime_mark_last_busy(qsdev->dev);
|
|
pm_runtime_put_autosuspend(qsdev->dev);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/**
|
|
* quickspi_dev_init - Initialize quickspi device
|
|
*
|
|
* @pdev: pointer to the thc pci device
|
|
* @mem_addr: The pointer of MMIO memory address
|
|
* @id: point to pci_device_id structure
|
|
*
|
|
* Alloc quickspi device structure and initialized THC device,
|
|
* then configure THC to HIDSPI mode.
|
|
*
|
|
* If success, enable THC hardware interrupt.
|
|
*
|
|
* Return: pointer to the quickspi device structure if success
|
|
* or NULL on failed.
|
|
*/
|
|
static struct quickspi_device *quickspi_dev_init(struct pci_dev *pdev, void __iomem *mem_addr,
|
|
const struct pci_device_id *id)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = devm_kzalloc(dev, sizeof(struct quickspi_device), GFP_KERNEL);
|
|
if (!qsdev)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
qsdev->pdev = pdev;
|
|
qsdev->dev = dev;
|
|
qsdev->mem_addr = mem_addr;
|
|
qsdev->state = QUICKSPI_DISABLED;
|
|
qsdev->driver_data = (struct quickspi_driver_data *)id->driver_data;
|
|
|
|
init_waitqueue_head(&qsdev->reset_ack_wq);
|
|
init_waitqueue_head(&qsdev->nondma_int_received_wq);
|
|
init_waitqueue_head(&qsdev->report_desc_got_wq);
|
|
init_waitqueue_head(&qsdev->get_report_cmpl_wq);
|
|
init_waitqueue_head(&qsdev->set_report_cmpl_wq);
|
|
|
|
/* 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);
|
|
}
|
|
|
|
/* THC config for input/output address */
|
|
thc_spi_input_output_address_config(qsdev->thc_hw,
|
|
qsdev->input_report_hdr_addr,
|
|
qsdev->input_report_bdy_addr,
|
|
qsdev->output_report_addr);
|
|
|
|
/* THC config for spi read operation */
|
|
ret = thc_spi_read_config(qsdev->thc_hw, qsdev->spi_freq_val,
|
|
qsdev->spi_read_io_mode,
|
|
qsdev->spi_read_opcode,
|
|
qsdev->spi_packet_size);
|
|
if (ret) {
|
|
dev_err(dev, "thc_spi_read_config failed, ret = %d\n", ret);
|
|
return ERR_PTR(ret);
|
|
}
|
|
|
|
/* THC config for spi write operation */
|
|
ret = thc_spi_write_config(qsdev->thc_hw, qsdev->spi_freq_val,
|
|
qsdev->spi_write_io_mode,
|
|
qsdev->spi_write_opcode,
|
|
qsdev->spi_packet_size,
|
|
qsdev->performance_limit);
|
|
if (ret) {
|
|
dev_err(dev, "thc_spi_write_config failed, ret = %d\n", ret);
|
|
return ERR_PTR(ret);
|
|
}
|
|
|
|
thc_ltr_config(qsdev->thc_hw,
|
|
qsdev->active_ltr_val,
|
|
qsdev->low_power_ltr_val);
|
|
|
|
thc_interrupt_config(qsdev->thc_hw);
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, true);
|
|
|
|
qsdev->state = QUICKSPI_INITED;
|
|
|
|
return qsdev;
|
|
}
|
|
|
|
/**
|
|
* quickspi_dev_deinit - De-initialize quickspi device
|
|
*
|
|
* @qsdev: pointer to the quickspi device structure
|
|
*
|
|
* Disable THC interrupt and deinitilize THC.
|
|
*/
|
|
static void quickspi_dev_deinit(struct quickspi_device *qsdev)
|
|
{
|
|
thc_interrupt_enable(qsdev->thc_hw, false);
|
|
thc_ltr_unconfig(qsdev->thc_hw);
|
|
|
|
qsdev->state = QUICKSPI_DISABLED;
|
|
}
|
|
|
|
/**
|
|
* 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.
|
|
*/
|
|
static int 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.
|
|
*
|
|
*/
|
|
static void 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.
|
|
*/
|
|
static int 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;
|
|
|
|
max_input_len = max(le16_to_cpu(qsdev->dev_desc.rep_desc_len),
|
|
le16_to_cpu(qsdev->dev_desc.max_input_len));
|
|
|
|
qsdev->input_buf = devm_kzalloc(qsdev->dev, max_input_len, GFP_KERNEL);
|
|
if (!qsdev->input_buf)
|
|
return -ENOMEM;
|
|
|
|
max_report_len = max(le16_to_cpu(qsdev->dev_desc.max_output_len),
|
|
le16_to_cpu(qsdev->dev_desc.max_input_len));
|
|
|
|
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.
|
|
*/
|
|
static int quickspi_probe(struct pci_dev *pdev,
|
|
const struct 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);
|
|
|
|
ret = pcim_iomap_regions(pdev, BIT(0), KBUILD_MODNAME);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to get PCI regions, ret = %d.\n", ret);
|
|
goto disable_pci_device;
|
|
}
|
|
|
|
mem_addr = pcim_iomap_table(pdev)[0];
|
|
|
|
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 unmap_io_region;
|
|
}
|
|
}
|
|
|
|
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 unmap_io_region;
|
|
}
|
|
|
|
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 unmap_io_region;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
qsdev->state = QUICKSPI_ENABLED;
|
|
|
|
/* Enable runtime power management */
|
|
pm_runtime_use_autosuspend(qsdev->dev);
|
|
pm_runtime_set_autosuspend_delay(qsdev->dev, DEFAULT_AUTO_SUSPEND_DELAY_MS);
|
|
pm_runtime_mark_last_busy(qsdev->dev);
|
|
pm_runtime_put_noidle(qsdev->dev);
|
|
pm_runtime_put_autosuspend(qsdev->dev);
|
|
|
|
dev_dbg(&pdev->dev, "QuickSPI probe success\n");
|
|
|
|
return 0;
|
|
|
|
dma_deinit:
|
|
quickspi_dma_deinit(qsdev);
|
|
dev_deinit:
|
|
quickspi_dev_deinit(qsdev);
|
|
unmap_io_region:
|
|
pcim_iounmap_regions(pdev, BIT(0));
|
|
disable_pci_device:
|
|
pci_clear_master(pdev);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* 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.
|
|
*/
|
|
static void quickspi_remove(struct pci_dev *pdev)
|
|
{
|
|
struct quickspi_device *qsdev;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return;
|
|
|
|
quickspi_hid_remove(qsdev);
|
|
quickspi_dma_deinit(qsdev);
|
|
|
|
pm_runtime_get_noresume(qsdev->dev);
|
|
|
|
quickspi_dev_deinit(qsdev);
|
|
|
|
pcim_iounmap_regions(pdev, BIT(0));
|
|
pci_clear_master(pdev);
|
|
}
|
|
|
|
/**
|
|
* 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.
|
|
*/
|
|
static void 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);
|
|
|
|
quickspi_dev_deinit(qsdev);
|
|
}
|
|
|
|
static int quickspi_suspend(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = quickspi_set_power(qsdev, HIDSPI_SLEEP);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, false);
|
|
|
|
thc_dma_unconfigure(qsdev->thc_hw);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_resume(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = thc_port_select(qsdev->thc_hw, THC_PORT_TYPE_SPI);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_config(qsdev->thc_hw);
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, true);
|
|
|
|
ret = thc_dma_configure(qsdev->thc_hw);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, false);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = quickspi_set_power(qsdev, HIDSPI_ON);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_freeze(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, false);
|
|
|
|
thc_dma_unconfigure(qsdev->thc_hw);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_thaw(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = thc_dma_configure(qsdev->thc_hw);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, true);
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, false);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_poweroff(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, false);
|
|
|
|
thc_ltr_unconfig(qsdev->thc_hw);
|
|
|
|
quickspi_dma_deinit(qsdev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_restore(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
int ret;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
ret = thc_interrupt_quiesce(qsdev->thc_hw, true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Reconfig THC HW when back from hibernate */
|
|
ret = thc_port_select(qsdev->thc_hw, THC_PORT_TYPE_SPI);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_spi_input_output_address_config(qsdev->thc_hw,
|
|
qsdev->input_report_hdr_addr,
|
|
qsdev->input_report_bdy_addr,
|
|
qsdev->output_report_addr);
|
|
|
|
ret = thc_spi_read_config(qsdev->thc_hw, qsdev->spi_freq_val,
|
|
qsdev->spi_read_io_mode,
|
|
qsdev->spi_read_opcode,
|
|
qsdev->spi_packet_size);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = thc_spi_write_config(qsdev->thc_hw, qsdev->spi_freq_val,
|
|
qsdev->spi_write_io_mode,
|
|
qsdev->spi_write_opcode,
|
|
qsdev->spi_packet_size,
|
|
qsdev->performance_limit);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_interrupt_config(qsdev->thc_hw);
|
|
|
|
thc_interrupt_enable(qsdev->thc_hw, true);
|
|
|
|
/* TIC may lose power, needs go through reset flow */
|
|
ret = reset_tic(qsdev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = thc_dma_configure(qsdev->thc_hw);
|
|
if (ret)
|
|
return ret;
|
|
|
|
thc_ltr_config(qsdev->thc_hw,
|
|
qsdev->active_ltr_val,
|
|
qsdev->low_power_ltr_val);
|
|
|
|
thc_change_ltr_mode(qsdev->thc_hw, THC_LTR_MODE_ACTIVE);
|
|
|
|
qsdev->state = QUICKSPI_ENABLED;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_runtime_suspend(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
thc_change_ltr_mode(qsdev->thc_hw, THC_LTR_MODE_LP);
|
|
|
|
pci_save_state(pdev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int quickspi_runtime_resume(struct device *device)
|
|
{
|
|
struct pci_dev *pdev = to_pci_dev(device);
|
|
struct quickspi_device *qsdev;
|
|
|
|
qsdev = pci_get_drvdata(pdev);
|
|
if (!qsdev)
|
|
return -ENODEV;
|
|
|
|
thc_change_ltr_mode(qsdev->thc_hw, THC_LTR_MODE_ACTIVE);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops quickspi_pm_ops = {
|
|
.suspend = quickspi_suspend,
|
|
.resume = quickspi_resume,
|
|
.freeze = quickspi_freeze,
|
|
.thaw = quickspi_thaw,
|
|
.poweroff = quickspi_poweroff,
|
|
.restore = quickspi_restore,
|
|
.runtime_suspend = quickspi_runtime_suspend,
|
|
.runtime_resume = quickspi_runtime_resume,
|
|
.runtime_idle = NULL,
|
|
};
|
|
|
|
static const struct pci_device_id quickspi_pci_tbl[] = {
|
|
{PCI_DEVICE_DATA(INTEL, THC_MTL_DEVICE_ID_SPI_PORT1, &mtl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_MTL_DEVICE_ID_SPI_PORT2, &mtl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_LNL_DEVICE_ID_SPI_PORT1, &lnl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_LNL_DEVICE_ID_SPI_PORT2, &lnl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_PTL_H_DEVICE_ID_SPI_PORT1, &ptl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_PTL_H_DEVICE_ID_SPI_PORT2, &ptl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_PTL_U_DEVICE_ID_SPI_PORT1, &ptl), },
|
|
{PCI_DEVICE_DATA(INTEL, THC_PTL_U_DEVICE_ID_SPI_PORT2, &ptl), },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, quickspi_pci_tbl);
|
|
|
|
static struct pci_driver quickspi_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = quickspi_pci_tbl,
|
|
.probe = quickspi_probe,
|
|
.remove = quickspi_remove,
|
|
.shutdown = quickspi_shutdown,
|
|
.driver.pm = &quickspi_pm_ops,
|
|
.driver.probe_type = PROBE_PREFER_ASYNCHRONOUS,
|
|
};
|
|
|
|
module_pci_driver(quickspi_driver);
|
|
|
|
MODULE_AUTHOR("Xinpeng Sun <xinpeng.sun@intel.com>");
|
|
MODULE_AUTHOR("Even Xu <even.xu@intel.com>");
|
|
|
|
MODULE_DESCRIPTION("Intel(R) QuickSPI Driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_IMPORT_NS("INTEL_THC");
|