mei: nfc: Add NFC device to the MEI bus
After building its bus name as a string based on its vendor id and radio type, we can add it to the bus. Signed-off-by: Samuel Ortiz <sameo@linux.intel.com> Signed-off-by: Tomas Winkler <tomas.winkler@intel.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
59fcd7c63a
commit
91a6b95f20
|
@ -102,6 +102,7 @@ struct mei_nfc_dev {
|
|||
u8 fw_ivn;
|
||||
u8 vendor_id;
|
||||
u8 radio_type;
|
||||
char *bus_name;
|
||||
};
|
||||
|
||||
static struct mei_nfc_dev nfc_dev;
|
||||
|
@ -115,6 +116,14 @@ static const uuid_le mei_nfc_info_guid = UUID_LE(0xd2de1625, 0x382d, 0x417d,
|
|||
0x48, 0xa4, 0xef, 0xab,
|
||||
0xba, 0x8a, 0x12, 0x06);
|
||||
|
||||
/* Vendors */
|
||||
#define MEI_NFC_VENDOR_INSIDE 0x00
|
||||
#define MEI_NFC_VENDOR_NXP 0x01
|
||||
|
||||
/* Radio types */
|
||||
#define MEI_NFC_VENDOR_INSIDE_UREAD 0x00
|
||||
#define MEI_NFC_VENDOR_NXP_PN544 0x01
|
||||
|
||||
static void mei_nfc_free(struct mei_nfc_dev *ndev)
|
||||
{
|
||||
if (ndev->cl) {
|
||||
|
@ -130,6 +139,51 @@ static void mei_nfc_free(struct mei_nfc_dev *ndev)
|
|||
}
|
||||
}
|
||||
|
||||
static int mei_nfc_build_bus_name(struct mei_nfc_dev *ndev)
|
||||
{
|
||||
struct mei_device *dev;
|
||||
|
||||
if (!ndev->cl)
|
||||
return -ENODEV;
|
||||
|
||||
dev = ndev->cl->dev;
|
||||
|
||||
switch (ndev->vendor_id) {
|
||||
case MEI_NFC_VENDOR_INSIDE:
|
||||
switch (ndev->radio_type) {
|
||||
case MEI_NFC_VENDOR_INSIDE_UREAD:
|
||||
ndev->bus_name = "microread";
|
||||
return 0;
|
||||
|
||||
default:
|
||||
dev_err(&dev->pdev->dev, "Unknow radio type 0x%x\n",
|
||||
ndev->radio_type);
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
case MEI_NFC_VENDOR_NXP:
|
||||
switch (ndev->radio_type) {
|
||||
case MEI_NFC_VENDOR_NXP_PN544:
|
||||
ndev->bus_name = "pn544";
|
||||
return 0;
|
||||
default:
|
||||
dev_err(&dev->pdev->dev, "Unknow radio type 0x%x\n",
|
||||
ndev->radio_type);
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
default:
|
||||
dev_err(&dev->pdev->dev, "Unknow vendor ID 0x%x\n",
|
||||
ndev->vendor_id);
|
||||
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mei_nfc_if_version(struct mei_nfc_dev *ndev)
|
||||
{
|
||||
struct mei_device *dev;
|
||||
|
@ -184,6 +238,7 @@ err:
|
|||
static void mei_nfc_init(struct work_struct *work)
|
||||
{
|
||||
struct mei_device *dev;
|
||||
struct mei_cl_device *cldev;
|
||||
struct mei_nfc_dev *ndev;
|
||||
struct mei_cl *cl_info;
|
||||
|
||||
|
@ -226,6 +281,23 @@ static void mei_nfc_init(struct work_struct *work)
|
|||
|
||||
mutex_unlock(&dev->device_lock);
|
||||
|
||||
if (mei_nfc_build_bus_name(ndev) < 0) {
|
||||
dev_err(&dev->pdev->dev,
|
||||
"Could not build the bus ID name\n");
|
||||
return;
|
||||
}
|
||||
|
||||
cldev = mei_cl_add_device(dev, mei_nfc_guid, ndev->bus_name, NULL);
|
||||
if (!cldev) {
|
||||
dev_err(&dev->pdev->dev,
|
||||
"Could not add the NFC device to the MEI bus\n");
|
||||
|
||||
goto err;
|
||||
}
|
||||
|
||||
cldev->priv_data = ndev;
|
||||
|
||||
|
||||
return;
|
||||
|
||||
err:
|
||||
|
@ -307,5 +379,8 @@ void mei_nfc_host_exit(void)
|
|||
{
|
||||
struct mei_nfc_dev *ndev = &nfc_dev;
|
||||
|
||||
if (ndev->cl && ndev->cl->device)
|
||||
mei_cl_remove_device(ndev->cl->device);
|
||||
|
||||
mei_nfc_free(ndev);
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue