Quelle  phy.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
/*
 * A wrapper for multiple PHYs which passes all phy_* function calls to
 * multiple (actual) PHY devices. This is comes handy when initializing
 * all PHYs on a HCD and to keep them all in the same state.
 *
 * Copyright (C) 2018 Martin Blumenstingl <martin.blumenstingl@googlemail.com>
 */

#include <linux/device.h>
#include <linux/list.h>
#include <linux/phy/phy.h>
#include <linux/of.h>

#include "phy.h"

struct usb_phy_roothub {
 struct phy  *phy;
 struct list_head list;
};

/* Allocate the roothub_entry by specific name of phy */
static int usb_phy_roothub_add_phy_by_name(struct device *dev, const char *name,
        struct list_head *list)
{
 struct usb_phy_roothub *roothub_entry;
 struct phy *phy;

 phy = devm_of_phy_get(dev, dev->of_node, name);
 if (IS_ERR(phy))
  return PTR_ERR(phy);

 roothub_entry = devm_kzalloc(dev, sizeof(*roothub_entry), GFP_KERNEL);
 if (!roothub_entry)
  return -ENOMEM;

 INIT_LIST_HEAD(&roothub_entry->list);

 roothub_entry->phy = phy;

 list_add_tail(&roothub_entry->list, list);

 return 0;
}

static int usb_phy_roothub_add_phy(struct device *dev, int index,
       struct list_head *list)
{
 struct usb_phy_roothub *roothub_entry;
 struct phy *phy;

 phy = devm_of_phy_get_by_index(dev, dev->of_node, index);
 if (IS_ERR(phy)) {
  if (PTR_ERR(phy) == -ENODEV)
   return 0;
  else
   return PTR_ERR(phy);
 }

 roothub_entry = devm_kzalloc(dev, sizeof(*roothub_entry), GFP_KERNEL);
 if (!roothub_entry)
  return -ENOMEM;

 INIT_LIST_HEAD(&roothub_entry->list);

 roothub_entry->phy = phy;

 list_add_tail(&roothub_entry->list, list);

 return 0;
}

struct usb_phy_roothub *usb_phy_roothub_alloc(struct device *dev)
{
 struct usb_phy_roothub *phy_roothub;
 int i, num_phys, err;

 if (!IS_ENABLED(CONFIG_GENERIC_PHY))
  return NULL;

 num_phys = of_count_phandle_with_args(dev->of_node, "phys",
           "#phy-cells");
 if (num_phys <= 0)
  return NULL;

 phy_roothub = devm_kzalloc(dev, sizeof(*phy_roothub), GFP_KERNEL);
 if (!phy_roothub)
  return ERR_PTR(-ENOMEM);

 INIT_LIST_HEAD(&phy_roothub->list);

 if (!usb_phy_roothub_add_phy_by_name(dev, "usb2-phy", &phy_roothub->list))
  return phy_roothub;

 for (i = 0; i < num_phys; i++) {
  err = usb_phy_roothub_add_phy(dev, i, &phy_roothub->list);
  if (err)
   return ERR_PTR(err);
 }

 return phy_roothub;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_alloc);

/**
 * usb_phy_roothub_alloc_usb3_phy - alloc the roothub
 * @dev: the device of the host controller
 *
 * Allocate the usb phy roothub if the host use a generic usb3-phy.
 *
 * Return: On success, a pointer to the usb_phy_roothub. Otherwise,
 * %NULL if no use usb3 phy or %-ENOMEM if out of memory.
 */
struct usb_phy_roothub *usb_phy_roothub_alloc_usb3_phy(struct device *dev)
{
 struct usb_phy_roothub *phy_roothub;
 int num_phys;

 if (!IS_ENABLED(CONFIG_GENERIC_PHY))
  return NULL;

 num_phys = of_count_phandle_with_args(dev->of_node, "phys",
           "#phy-cells");
 if (num_phys <= 0)
  return NULL;

 phy_roothub = devm_kzalloc(dev, sizeof(*phy_roothub), GFP_KERNEL);
 if (!phy_roothub)
  return ERR_PTR(-ENOMEM);

 INIT_LIST_HEAD(&phy_roothub->list);

 if (!usb_phy_roothub_add_phy_by_name(dev, "usb3-phy", &phy_roothub->list))
  return phy_roothub;

 return NULL;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_alloc_usb3_phy);

int usb_phy_roothub_init(struct usb_phy_roothub *phy_roothub)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_init(roothub_entry->phy);
  if (err)
   goto err_exit_phys;
 }

 return 0;

err_exit_phys:
 list_for_each_entry_continue_reverse(roothub_entry, head, list)
  phy_exit(roothub_entry->phy);

 return err;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_init);

int usb_phy_roothub_exit(struct usb_phy_roothub *phy_roothub)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err, ret = 0;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_exit(roothub_entry->phy);
  if (err)
   ret = err;
 }

 return ret;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_exit);

int usb_phy_roothub_set_mode(struct usb_phy_roothub *phy_roothub,
        enum phy_mode mode)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_set_mode(roothub_entry->phy, mode);
  if (err)
   goto err_out;
 }

 return 0;

err_out:
 list_for_each_entry_continue_reverse(roothub_entry, head, list)
  phy_power_off(roothub_entry->phy);

 return err;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_set_mode);

int usb_phy_roothub_calibrate(struct usb_phy_roothub *phy_roothub)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_calibrate(roothub_entry->phy);
  if (err)
   return err;
 }

 return 0;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_calibrate);

/**
 * usb_phy_roothub_notify_connect() - connect notification
 * @phy_roothub: the phy of roothub, if the host use a generic phy.
 * @port: the port index for connect
 *
 * If the phy needs to get connection status, the callback can be used.
 * Returns: %0 if successful, a negative error code otherwise
 */
int usb_phy_roothub_notify_connect(struct usb_phy_roothub *phy_roothub, int port)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_notify_connect(roothub_entry->phy, port);
  if (err)
   return err;
 }

 return 0;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_notify_connect);

/**
 * usb_phy_roothub_notify_disconnect() - disconnect notification
 * @phy_roothub: the phy of roothub, if the host use a generic phy.
 * @port: the port index for disconnect
 *
 * If the phy needs to get connection status, the callback can be used.
 * Returns: %0 if successful, a negative error code otherwise
 */
int usb_phy_roothub_notify_disconnect(struct usb_phy_roothub *phy_roothub, int port)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_notify_disconnect(roothub_entry->phy, port);
  if (err)
   return err;
 }

 return 0;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_notify_disconnect);

int usb_phy_roothub_power_on(struct usb_phy_roothub *phy_roothub)
{
 struct usb_phy_roothub *roothub_entry;
 struct list_head *head;
 int err;

 if (!phy_roothub)
  return 0;

 head = &phy_roothub->list;

 list_for_each_entry(roothub_entry, head, list) {
  err = phy_power_on(roothub_entry->phy);
  if (err)
   goto err_out;
 }

 return 0;

err_out:
 list_for_each_entry_continue_reverse(roothub_entry, head, list)
  phy_power_off(roothub_entry->phy);

 return err;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_power_on);

void usb_phy_roothub_power_off(struct usb_phy_roothub *phy_roothub)
{
 struct usb_phy_roothub *roothub_entry;

 if (!phy_roothub)
  return;

 list_for_each_entry_reverse(roothub_entry, &phy_roothub->list, list)
  phy_power_off(roothub_entry->phy);
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_power_off);

int usb_phy_roothub_suspend(struct device *controller_dev,
       struct usb_phy_roothub *phy_roothub)
{
 usb_phy_roothub_power_off(phy_roothub);

 /* keep the PHYs initialized so the device can wake up the system */
 if (device_may_wakeup(controller_dev))
  return 0;

 return usb_phy_roothub_exit(phy_roothub);
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_suspend);

int usb_phy_roothub_resume(struct device *controller_dev,
      struct usb_phy_roothub *phy_roothub)
{
 int err;

 /* if the device can't wake up the system _exit was called */
 if (!device_may_wakeup(controller_dev)) {
  err = usb_phy_roothub_init(phy_roothub);
  if (err)
   return err;
 }

 err = usb_phy_roothub_power_on(phy_roothub);

 /* undo _init if _power_on failed */
 if (err && !device_may_wakeup(controller_dev))
  usb_phy_roothub_exit(phy_roothub);

 return err;
}
EXPORT_SYMBOL_GPL(usb_phy_roothub_resume);