@@ -1061,7 +1061,8 @@ struct mhi_device *mhi_alloc_device(struct mhi_controller *mhi_cntrl)
dev->release = mhi_release_device;
dev->parent = mhi_cntrl->cntrl_dev;
mhi_dev->mhi_cntrl = mhi_cntrl;
- mhi_dev->dev_wake = 0;
+ atomic_set(&mhi_dev->dev_vote, 0);
+ atomic_set(&mhi_dev->bus_vote, 0);
return mhi_dev;
}
@@ -1078,7 +1079,7 @@ static int mhi_driver_probe(struct device *dev)
int ret;
/* Bring device out of LPM */
- ret = mhi_device_get_sync(mhi_dev);
+ ret = mhi_device_get_sync(mhi_dev, MHI_VOTE_DEVICE);
if (ret)
return ret;
@@ -1137,14 +1138,14 @@ static int mhi_driver_probe(struct device *dev)
if (dl_chan && dl_chan->auto_start)
mhi_prepare_channel(mhi_cntrl, dl_chan);
- mhi_device_put(mhi_dev);
+ mhi_device_put(mhi_dev, MHI_VOTE_DEVICE);
return ret;
exit_probe:
mhi_unprepare_from_transfer(mhi_dev);
- mhi_device_put(mhi_dev);
+ mhi_device_put(mhi_dev, MHI_VOTE_DEVICE);
return ret;
}
@@ -1213,8 +1214,10 @@ static int mhi_driver_remove(struct device *dev)
}
read_lock_bh(&mhi_cntrl->pm_lock);
- while (mhi_dev->dev_wake)
- mhi_device_put(mhi_dev);
+ while (atomic_read(&mhi_dev->dev_vote))
+ mhi_device_put(mhi_dev, MHI_VOTE_DEVICE);
+ while (atomic_read(&mhi_dev->bus_vote))
+ mhi_device_put(mhi_dev, MHI_VOTE_BUS);
read_unlock_bh(&mhi_cntrl->pm_lock);
return 0;
@@ -675,7 +675,8 @@ void mhi_pm_st_worker(struct work_struct *work)
int mhi_pm_suspend(struct mhi_controller *mhi_cntrl)
{
struct mhi_chan *itr, *tmp;
- struct device *dev = &mhi_cntrl->mhi_dev->dev;
+ struct mhi_device *mhi_dev = mhi_cntrl->mhi_dev;
+ struct device *dev = &mhi_dev->dev;
enum mhi_pm_state new_state;
int ret;
@@ -686,7 +687,8 @@ int mhi_pm_suspend(struct mhi_controller *mhi_cntrl)
return -EIO;
/* Return busy if there are any pending resources */
- if (atomic_read(&mhi_cntrl->dev_wake))
+ if (atomic_read(&mhi_cntrl->dev_wake) ||
+ atomic_read(&mhi_dev->bus_vote))
return -EBUSY;
/* Take MHI out of M2 state */
@@ -712,10 +714,9 @@ int mhi_pm_suspend(struct mhi_controller *mhi_cntrl)
write_lock_irq(&mhi_cntrl->pm_lock);
- if (atomic_read(&mhi_cntrl->dev_wake)) {
- write_unlock_irq(&mhi_cntrl->pm_lock);
+ if (atomic_read(&mhi_cntrl->dev_wake) ||
+ atomic_read(&mhi_dev->bus_vote))
return -EBUSY;
- }
dev_info(dev, "Allowing M3 transition\n");
new_state = mhi_tryset_pm_state(mhi_cntrl, MHI_PM_M3_ENTER);
@@ -1080,42 +1081,74 @@ int mhi_force_rddm_mode(struct mhi_controller *mhi_cntrl)
}
EXPORT_SYMBOL_GPL(mhi_force_rddm_mode);
-void mhi_device_get(struct mhi_device *mhi_dev)
+void mhi_device_get(struct mhi_device *mhi_dev, int vote)
{
struct mhi_controller *mhi_cntrl = mhi_dev->mhi_cntrl;
- mhi_dev->dev_wake++;
- read_lock_bh(&mhi_cntrl->pm_lock);
- mhi_cntrl->wake_get(mhi_cntrl, true);
- read_unlock_bh(&mhi_cntrl->pm_lock);
+ if (vote & MHI_VOTE_DEVICE) {
+ atomic_inc(&mhi_dev->dev_vote);
+ read_lock_bh(&mhi_cntrl->pm_lock);
+ mhi_cntrl->wake_get(mhi_cntrl, true);
+ read_unlock_bh(&mhi_cntrl->pm_lock);
+ }
+
+ if (vote & MHI_VOTE_BUS) {
+ atomic_inc(&mhi_dev->bus_vote);
+ mhi_cntrl->runtime_get(mhi_cntrl);
+ }
}
EXPORT_SYMBOL_GPL(mhi_device_get);
-int mhi_device_get_sync(struct mhi_device *mhi_dev)
+int mhi_device_get_sync(struct mhi_device *mhi_dev, int vote)
{
struct mhi_controller *mhi_cntrl = mhi_dev->mhi_cntrl;
int ret;
+ /* bring device out of low power modes regardless of the type of vote */
ret = __mhi_device_get_sync(mhi_cntrl);
- if (!ret)
- mhi_dev->dev_wake++;
+ if (ret)
+ return ret;
+
+ if (vote & MHI_VOTE_DEVICE) {
+ atomic_inc(&mhi_dev->dev_vote);
+ } else {
+ /* remove device vote as it was not requested */
+ read_lock_bh(&mhi_cntrl->pm_lock);
+ mhi_cntrl->wake_put(mhi_cntrl, false);
+ read_unlock_bh(&mhi_cntrl->pm_lock);
+ }
+
+ if (vote & MHI_VOTE_BUS) {
+ atomic_inc(&mhi_dev->bus_vote);
+ mhi_cntrl->runtime_get(mhi_cntrl);
+ }
return ret;
}
EXPORT_SYMBOL_GPL(mhi_device_get_sync);
-void mhi_device_put(struct mhi_device *mhi_dev)
+void mhi_device_put(struct mhi_device *mhi_dev, int vote)
{
struct mhi_controller *mhi_cntrl = mhi_dev->mhi_cntrl;
- mhi_dev->dev_wake--;
- read_lock_bh(&mhi_cntrl->pm_lock);
- if (MHI_PM_IN_SUSPEND_STATE(mhi_cntrl->pm_state)) {
- mhi_cntrl->runtime_get(mhi_cntrl);
- mhi_cntrl->runtime_put(mhi_cntrl);
+ if (vote & MHI_VOTE_DEVICE) {
+ atomic_dec(&mhi_dev->dev_vote);
+ read_lock_bh(&mhi_cntrl->pm_lock);
+ if (MHI_PM_IN_SUSPEND_STATE(mhi_cntrl->pm_state)) {
+ mhi_cntrl->runtime_get(mhi_cntrl);
+ mhi_cntrl->runtime_put(mhi_cntrl);
+ }
+ mhi_cntrl->wake_put(mhi_cntrl, false);
+ read_unlock_bh(&mhi_cntrl->pm_lock);
}
- mhi_cntrl->wake_put(mhi_cntrl, false);
- read_unlock_bh(&mhi_cntrl->pm_lock);
+ if (vote & MHI_VOTE_BUS) {
+ atomic_dec(&mhi_dev->bus_vote);
+ mhi_cntrl->runtime_put(mhi_cntrl);
+
+ /* notify controller that all bus votes are removed */
+ if (!atomic_read(&mhi_dev->bus_vote))
+ mhi_cntrl->status_cb(mhi_cntrl, MHI_CB_IDLE);
+ }
}
EXPORT_SYMBOL_GPL(mhi_device_put);
@@ -16,6 +16,9 @@
#include <linux/wait.h>
#include <linux/workqueue.h>
+#define MHI_VOTE_BUS BIT(0) /* do not disable the mhi bus */
+#define MHI_VOTE_DEVICE BIT(1) /* prevent mhi device from entering lpm */
+
struct mhi_chan;
struct mhi_event;
struct mhi_ctxt;
@@ -459,7 +462,8 @@ struct mhi_device {
enum mhi_device_type dev_type;
int ul_chan_id;
int dl_chan_id;
- u32 dev_wake;
+ atomic_t dev_vote;
+ atomic_t bus_vote;
};
/**
@@ -644,23 +648,26 @@ void mhi_set_mhi_state(struct mhi_controller *mhi_cntrl,
enum mhi_state mhi_get_mhi_state(struct mhi_controller *mhi_cntrl);
/**
- * mhi_device_get - Disable device low power mode
+ * mhi_device_get - Disable device and/or bus low power mode
* @mhi_dev: Device associated with the channel
+ * @vote: requested vote (bus, device or both)
*/
-void mhi_device_get(struct mhi_device *mhi_dev);
+void mhi_device_get(struct mhi_device *mhi_dev, int vote);
/**
- * mhi_device_get_sync - Disable device low power mode. Synchronously
+ * mhi_device_get_sync - Disable device and/or bus low power mode. Synchronously
* take the controller out of suspended state
* @mhi_dev: Device associated with the channel
+ * @vote: requested vote (bus, device or both)
*/
-int mhi_device_get_sync(struct mhi_device *mhi_dev);
+int mhi_device_get_sync(struct mhi_device *mhi_dev, int vote);
/**
- * mhi_device_put - Re-enable device low power mode
+ * mhi_device_put - Re-enable device and/or bus low power mode
* @mhi_dev: Device associated with the channel
+ * @vote: vote(s) to remove (bus, device or both)
*/
-void mhi_device_put(struct mhi_device *mhi_dev);
+void mhi_device_put(struct mhi_device *mhi_dev, int vote);
/**
* mhi_prepare_for_transfer - Setup channel for data transfer
Allow independent votes from clients such that they can choose to vote for either the device or the bus or both. This helps in cases where the device supports autonomous low power mode wherein it can move to M2 state without the need to notify the host. Clients can also vote only to keep the underlying bus active without having the device in M0 state to support offload use cases. Signed-off-by: Bhaumik Bhatt <bbhatt@codeaurora.org> --- drivers/bus/mhi/core/init.c | 15 +++++---- drivers/bus/mhi/core/pm.c | 75 ++++++++++++++++++++++++++++++++------------- include/linux/mhi.h | 21 ++++++++----- 3 files changed, 77 insertions(+), 34 deletions(-)