Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 | // SPDX-License-Identifier: GPL-2.0-only /* * inv_mpu_acpi: ACPI processing for creating client devices * Copyright (c) 2015, Intel Corporation. */ #ifdef CONFIG_ACPI #include <linux/kernel.h> #include <linux/i2c.h> #include <linux/dmi.h> #include <linux/acpi.h> #include "inv_mpu_iio.h" enum inv_mpu_product_name { INV_MPU_NOT_MATCHED, INV_MPU_ASUS_T100TA, }; static enum inv_mpu_product_name matched_product_name; static int __init asus_t100_matched(const struct dmi_system_id *d) { matched_product_name = INV_MPU_ASUS_T100TA; return 0; } static const struct dmi_system_id inv_mpu_dev_list[] = { { .callback = asus_t100_matched, .ident = "Asus Transformer Book T100", .matches = { DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK COMPUTER INC"), DMI_MATCH(DMI_PRODUCT_NAME, "T100TA"), DMI_MATCH(DMI_PRODUCT_VERSION, "1.0"), }, }, /* Add more matching tables here..*/ {} }; static int asus_acpi_get_sensor_info(struct acpi_device *adev, struct i2c_client *client, struct i2c_board_info *info) { struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; int i; acpi_status status; union acpi_object *cpm; int ret; status = acpi_evaluate_object(adev->handle, "CNF0", NULL, &buffer); if (ACPI_FAILURE(status)) return -ENODEV; cpm = buffer.pointer; for (i = 0; i < cpm->package.count; ++i) { union acpi_object *elem; int j; elem = &cpm->package.elements[i]; for (j = 0; j < elem->package.count; ++j) { union acpi_object *sub_elem; sub_elem = &elem->package.elements[j]; if (sub_elem->type == ACPI_TYPE_STRING) strscpy(info->type, sub_elem->string.pointer, sizeof(info->type)); else if (sub_elem->type == ACPI_TYPE_INTEGER) { if (sub_elem->integer.value != client->addr) { info->addr = sub_elem->integer.value; break; /* Not a MPU6500 primary */ } } } } ret = cpm->package.count; kfree(buffer.pointer); return ret; } static int acpi_i2c_check_resource(struct acpi_resource *ares, void *data) { struct acpi_resource_i2c_serialbus *sb; u32 *addr = data; if (i2c_acpi_get_i2c_resource(ares, &sb)) { if (*addr) *addr |= (sb->slave_address << 16); else *addr = sb->slave_address; } /* Tell the ACPI core that we already copied this address */ return 1; } static int inv_mpu_process_acpi_config(struct i2c_client *client, unsigned short *primary_addr, unsigned short *secondary_addr) { struct acpi_device *adev = ACPI_COMPANION(&client->dev); const struct acpi_device_id *id; u32 i2c_addr = 0; LIST_HEAD(resources); int ret; id = acpi_match_device(client->dev.driver->acpi_match_table, &client->dev); if (!id) return -ENODEV; ret = acpi_dev_get_resources(adev, &resources, acpi_i2c_check_resource, &i2c_addr); if (ret < 0) return ret; acpi_dev_free_resource_list(&resources); *primary_addr = i2c_addr & 0x0000ffff; *secondary_addr = (i2c_addr & 0xffff0000) >> 16; return 0; } int inv_mpu_acpi_create_mux_client(struct i2c_client *client) { struct inv_mpu6050_state *st = iio_priv(dev_get_drvdata(&client->dev)); struct acpi_device *adev = ACPI_COMPANION(&client->dev); st->mux_client = NULL; if (adev) { struct i2c_board_info info; struct i2c_client *mux_client; int ret = -1; memset(&info, 0, sizeof(info)); dmi_check_system(inv_mpu_dev_list); switch (matched_product_name) { case INV_MPU_ASUS_T100TA: ret = asus_acpi_get_sensor_info(adev, client, &info); break; /* Add more matched product processing here */ default: break; } if (ret < 0) { /* No matching DMI, so create device on INV6XX type */ unsigned short primary, secondary; ret = inv_mpu_process_acpi_config(client, &primary, &secondary); if (!ret && secondary) { char *name; info.addr = secondary; strscpy(info.type, dev_name(&adev->dev), sizeof(info.type)); name = strchr(info.type, ':'); if (name) *name = '\0'; strlcat(info.type, "-client", sizeof(info.type)); } else return 0; /* no secondary addr, which is OK */ } mux_client = i2c_new_client_device(st->muxc->adapter[0], &info); if (IS_ERR(mux_client)) return PTR_ERR(mux_client); st->mux_client = mux_client; } return 0; } void inv_mpu_acpi_delete_mux_client(struct i2c_client *client) { struct inv_mpu6050_state *st = iio_priv(dev_get_drvdata(&client->dev)); i2c_unregister_device(st->mux_client); } #else #include "inv_mpu_iio.h" int inv_mpu_acpi_create_mux_client(struct i2c_client *client) { return 0; } void inv_mpu_acpi_delete_mux_client(struct i2c_client *client) { } #endif |