linux/drivers/staging/greybus/spi.c
<<
>>
Prefs
   1/*
   2 * SPI bridge PHY driver.
   3 *
   4 * Copyright 2014-2016 Google Inc.
   5 * Copyright 2014-2016 Linaro Ltd.
   6 *
   7 * Released under the GPLv2 only.
   8 */
   9
  10#include <linux/module.h>
  11
  12#include "greybus.h"
  13#include "gbphy.h"
  14#include "spilib.h"
  15
  16static struct spilib_ops *spilib_ops;
  17
  18static int gb_spi_probe(struct gbphy_device *gbphy_dev,
  19                        const struct gbphy_device_id *id)
  20{
  21        struct gb_connection *connection;
  22        int ret;
  23
  24        connection = gb_connection_create(gbphy_dev->bundle,
  25                                          le16_to_cpu(gbphy_dev->cport_desc->id),
  26                                          NULL);
  27        if (IS_ERR(connection))
  28                return PTR_ERR(connection);
  29
  30        ret = gb_connection_enable(connection);
  31        if (ret)
  32                goto exit_connection_destroy;
  33
  34        ret = gb_spilib_master_init(connection, &gbphy_dev->dev, spilib_ops);
  35        if (ret)
  36                goto exit_connection_disable;
  37
  38        gb_gbphy_set_data(gbphy_dev, connection);
  39
  40        gbphy_runtime_put_autosuspend(gbphy_dev);
  41        return 0;
  42
  43exit_connection_disable:
  44        gb_connection_disable(connection);
  45exit_connection_destroy:
  46        gb_connection_destroy(connection);
  47
  48        return ret;
  49}
  50
  51static void gb_spi_remove(struct gbphy_device *gbphy_dev)
  52{
  53        struct gb_connection *connection = gb_gbphy_get_data(gbphy_dev);
  54        int ret;
  55
  56        ret = gbphy_runtime_get_sync(gbphy_dev);
  57        if (ret)
  58                gbphy_runtime_get_noresume(gbphy_dev);
  59
  60        gb_spilib_master_exit(connection);
  61        gb_connection_disable(connection);
  62        gb_connection_destroy(connection);
  63}
  64
  65static const struct gbphy_device_id gb_spi_id_table[] = {
  66        { GBPHY_PROTOCOL(GREYBUS_PROTOCOL_SPI) },
  67        { },
  68};
  69MODULE_DEVICE_TABLE(gbphy, gb_spi_id_table);
  70
  71static struct gbphy_driver spi_driver = {
  72        .name           = "spi",
  73        .probe          = gb_spi_probe,
  74        .remove         = gb_spi_remove,
  75        .id_table       = gb_spi_id_table,
  76};
  77
  78module_gbphy_driver(spi_driver);
  79MODULE_LICENSE("GPL v2");
  80