diff --git a/components/dsc/src/wlan_dsc_psoc.c b/components/dsc/src/wlan_dsc_psoc.c index 7bbea0cc1197..50e3b8123367 100644 --- a/components/dsc/src/wlan_dsc_psoc.c +++ b/components/dsc/src/wlan_dsc_psoc.c @@ -16,3 +16,343 @@ * PERFORMANCE OF THIS SOFTWARE. */ +#include "qdf_list.h" +#include "qdf_mem.h" +#include "qdf_status.h" +#include "qdf_types.h" +#include "__wlan_dsc.h" +#include "wlan_dsc.h" + +static QDF_STATUS +__dsc_psoc_create(struct dsc_driver *driver, struct dsc_psoc **out_psoc) +{ + struct dsc_psoc *psoc; + + if (!dsc_assert(driver)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(out_psoc)) + return QDF_STATUS_E_INVAL; + + *out_psoc = NULL; + + psoc = qdf_mem_malloc(sizeof(*psoc)); + if (!psoc) + return QDF_STATUS_E_NOMEM; + + /* init */ + psoc->driver = driver; + qdf_list_create(&psoc->vdevs, 0); + __dsc_trans_init(&psoc->trans); + __dsc_ops_init(&psoc->ops); + + /* attach */ + __dsc_lock(); + qdf_list_insert_back(&driver->psocs, &psoc->node); + __dsc_unlock(); + + *out_psoc = psoc; + + return QDF_STATUS_SUCCESS; +} + +QDF_STATUS +dsc_psoc_create(struct dsc_driver *driver, struct dsc_psoc **out_psoc) +{ + QDF_STATUS status; + + dsc_enter(); + status = __dsc_psoc_create(driver, out_psoc); + dsc_exit(); + + return status; +} + +static void __dsc_psoc_destroy(struct dsc_psoc **out_psoc) +{ + struct dsc_psoc *psoc; + + if (!dsc_assert(out_psoc)) + return; + + psoc = *out_psoc; + if (!dsc_assert(psoc)) + return; + + *out_psoc = NULL; + + /* assert no children */ + dsc_assert(qdf_list_empty(&psoc->vdevs)); + + /* flush pending transitions */ + while (__dsc_trans_abort(&psoc->trans)) + ; + + /* detach */ + __dsc_lock(); + qdf_list_remove_node(&psoc->driver->psocs, &psoc->node); + __dsc_unlock(); + + /* de-init */ + __dsc_ops_deinit(&psoc->ops); + __dsc_trans_deinit(&psoc->trans); + qdf_list_destroy(&psoc->vdevs); + psoc->driver = NULL; + + qdf_mem_free(psoc); +} + +void dsc_psoc_destroy(struct dsc_psoc **out_psoc) +{ + dsc_enter(); + __dsc_psoc_destroy(out_psoc); + dsc_exit(); +} + +static bool __dsc_psoc_trans_active_down_tree(struct dsc_psoc *psoc) +{ + struct dsc_vdev *vdev; + + dsc_for_each_psoc_vdev(psoc, vdev) { + if (__dsc_trans_active(&vdev->trans)) + return true; + } + + return false; +} + +static bool __dsc_psoc_can_op(struct dsc_psoc *psoc) +{ + return !__dsc_trans_active_or_queued(&psoc->driver->trans) && + !__dsc_trans_active_or_queued(&psoc->trans); +} + +static bool __dsc_psoc_can_trans(struct dsc_psoc *psoc) +{ + return !__dsc_trans_active_or_queued(&psoc->driver->trans) && + !__dsc_trans_active_or_queued(&psoc->trans) && + !__dsc_psoc_trans_active_down_tree(psoc); +} + +static bool __dsc_psoc_can_trigger(struct dsc_psoc *psoc) +{ + return !__dsc_trans_active_or_queued(&psoc->driver->trans) && + !__dsc_trans_active(&psoc->trans) && + !__dsc_psoc_trans_active_down_tree(psoc); +} + +static QDF_STATUS +__dsc_psoc_trans_start_nolock(struct dsc_psoc *psoc, const char *desc) +{ + if (!__dsc_psoc_can_trans(psoc)) + return QDF_STATUS_E_AGAIN; + + psoc->trans.active_desc = desc; + + return QDF_STATUS_SUCCESS; +} + +static QDF_STATUS +__dsc_psoc_trans_start(struct dsc_psoc *psoc, const char *desc) +{ + QDF_STATUS status; + + if (!dsc_assert(psoc)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(desc)) + return QDF_STATUS_E_INVAL; + + __dsc_lock(); + status = __dsc_psoc_trans_start_nolock(psoc, desc); + __dsc_unlock(); + + return status; +} + +QDF_STATUS dsc_psoc_trans_start(struct dsc_psoc *psoc, const char *desc) +{ + QDF_STATUS status; + + dsc_enter_str(desc); + status = __dsc_psoc_trans_start(psoc, desc); + dsc_exit_status(status); + + return status; +} + +static QDF_STATUS +__dsc_psoc_trans_start_wait(struct dsc_psoc *psoc, const char *desc) +{ + QDF_STATUS status; + struct dsc_tran tran = { 0 }; + + if (!dsc_assert(psoc)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(desc)) + return QDF_STATUS_E_INVAL; + + __dsc_lock(); + + status = __dsc_psoc_trans_start_nolock(psoc, desc); + if (QDF_IS_STATUS_SUCCESS(status)) { + __dsc_unlock(); + return QDF_STATUS_SUCCESS; + } + + __dsc_trans_queue(&psoc->trans, &tran, desc); + + __dsc_unlock(); + + return __dsc_tran_wait(&tran); +} + +QDF_STATUS dsc_psoc_trans_start_wait(struct dsc_psoc *psoc, const char *desc) +{ + QDF_STATUS status; + + dsc_enter_str(desc); + status = __dsc_psoc_trans_start_wait(psoc, desc); + dsc_exit_status(status); + + return status; +} + +static void __dsc_psoc_trigger_trans(struct dsc_psoc *psoc) +{ + struct dsc_vdev *vdev; + + if (__dsc_driver_trans_trigger_checked(psoc->driver)) + return; + + if (__dsc_trans_trigger(&psoc->trans)) + return; + + dsc_for_each_psoc_vdev(psoc, vdev) + __dsc_trans_trigger(&vdev->trans); +} + +static void __dsc_psoc_trans_stop(struct dsc_psoc *psoc) +{ + if (!dsc_assert(psoc)) + return; + + dsc_assert(psoc->trans.active_desc); + psoc->trans.active_desc = NULL; + + __dsc_psoc_trigger_trans(psoc); +} + +void dsc_psoc_trans_stop(struct dsc_psoc *psoc) +{ + dsc_enter(); + __dsc_lock(); + __dsc_psoc_trans_stop(psoc); + __dsc_unlock(); + dsc_exit(); +} + +void dsc_psoc_trans_assert(struct dsc_psoc *psoc) +{ + dsc_enter(); + __dsc_lock(); + dsc_assert(psoc->trans.active_desc); + __dsc_unlock(); + dsc_exit(); +} + +bool __dsc_psoc_trans_trigger_checked(struct dsc_psoc *psoc) +{ + if (qdf_list_empty(&psoc->trans.queue)) + return false; + + /* handled, but don't trigger; we need to wait for more children */ + if (!__dsc_psoc_can_trigger(psoc)) + return true; + + return __dsc_trans_trigger(&psoc->trans); +} + +static QDF_STATUS __dsc_psoc_op_start(struct dsc_psoc *psoc, const char *func) +{ + if (!dsc_assert(psoc)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(func)) + return QDF_STATUS_E_INVAL; + + if (!__dsc_psoc_can_op(psoc)) + return QDF_STATUS_E_AGAIN; + + return __dsc_ops_insert(&psoc->ops, func); +} + +QDF_STATUS _dsc_psoc_op_start(struct dsc_psoc *psoc, const char *func) +{ + QDF_STATUS status; + + dsc_enter_str(func); + __dsc_lock(); + status = __dsc_psoc_op_start(psoc, func); + __dsc_unlock(); + dsc_exit_status(status); + + return status; +} + +static void __dsc_psoc_op_stop(struct dsc_psoc *psoc, const char *func) +{ + if (!dsc_assert(psoc)) + return; + + if (!dsc_assert(func)) + return; + + if (__dsc_ops_remove(&psoc->ops, func)) + qdf_event_set(&psoc->ops.event); +} + +void _dsc_psoc_op_stop(struct dsc_psoc *psoc, const char *func) +{ + dsc_enter_str(func); + __dsc_lock(); + __dsc_psoc_op_stop(psoc, func); + __dsc_unlock(); + dsc_exit(); +} + +static void __dsc_psoc_wait_for_ops(struct dsc_psoc *psoc) +{ + struct dsc_vdev *vdev; + bool wait; + + if (!dsc_assert(psoc)) + return; + + __dsc_lock(); + + /* flushing without preventing new ops is almost certainly a bug */ + dsc_assert(!__dsc_psoc_can_op(psoc)); + + wait = psoc->ops.count > 0; + if (wait) + qdf_event_reset(&psoc->ops.event); + + __dsc_unlock(); + + if (wait) + qdf_wait_single_event(&psoc->ops.event, 0); + + /* wait for down-tree ops to complete as well */ + dsc_for_each_psoc_vdev(psoc, vdev) + dsc_vdev_wait_for_ops(vdev); +} + +void dsc_psoc_wait_for_ops(struct dsc_psoc *psoc) +{ + dsc_enter(); + __dsc_psoc_wait_for_ops(psoc); + dsc_exit(); +} +