diff --git a/components/dsc/src/wlan_dsc_driver.c b/components/dsc/src/wlan_dsc_driver.c index 7bbea0cc11..da7d46c4a8 100644 --- a/components/dsc/src/wlan_dsc_driver.c +++ b/components/dsc/src/wlan_dsc_driver.c @@ -16,3 +16,351 @@ * PERFORMANCE OF THIS SOFTWARE. */ +#include "qdf_list.h" +#include "qdf_status.h" +#include "qdf_types.h" +#include "__wlan_dsc.h" +#include "wlan_dsc.h" + +static struct dsc_driver __dsc_ctx; +static bool __dsc_init; + +void __dsc_lock(void) +{ + dsc_assert(__dsc_init); + qdf_spin_lock_bh(&__dsc_ctx.lock); +} + +void __dsc_unlock(void) +{ + dsc_assert(__dsc_init); + qdf_spin_unlock_bh(&__dsc_ctx.lock); +} + +static QDF_STATUS __dsc_driver_create(struct dsc_driver **out_driver) +{ + struct dsc_driver *driver; + + if (!dsc_assert(!__dsc_init)) + return QDF_STATUS_E_ALREADY; + + if (!dsc_assert(out_driver)) + return QDF_STATUS_E_INVAL; + + *out_driver = NULL; + + __dsc_init = true; + driver = &__dsc_ctx; + + qdf_spinlock_create(&driver->lock); + qdf_list_create(&driver->psocs, 0); + __dsc_trans_init(&driver->trans); + __dsc_ops_init(&driver->ops); + + *out_driver = driver; + + return QDF_STATUS_SUCCESS; +} + +QDF_STATUS dsc_driver_create(struct dsc_driver **out_driver) +{ + QDF_STATUS status; + + dsc_enter(); + status = __dsc_driver_create(out_driver); + dsc_exit(); + + return status; +} + +static void __dsc_driver_destroy(struct dsc_driver **out_driver) +{ + struct dsc_driver *driver; + + if (!dsc_assert(out_driver)) + return; + + driver = *out_driver; + if (!dsc_assert(driver)) + return; + + *out_driver = NULL; + + /* assert no children */ + dsc_assert(qdf_list_empty(&driver->psocs)); + + /* flush pending transitions */ + while (__dsc_trans_abort(&driver->trans)) + ; + + /* de-init */ + __dsc_ops_deinit(&driver->ops); + __dsc_trans_deinit(&driver->trans); + qdf_list_destroy(&driver->psocs); + qdf_spinlock_destroy(&driver->lock); + + __dsc_init = false; +} + +void dsc_driver_destroy(struct dsc_driver **out_driver) +{ + dsc_enter(); + __dsc_driver_destroy(out_driver); + dsc_exit(); +} + +static bool __dsc_driver_trans_active_down_tree(struct dsc_driver *driver) +{ + struct dsc_psoc *psoc; + struct dsc_vdev *vdev; + + dsc_for_each_driver_psoc(driver, psoc) { + if (__dsc_trans_active(&psoc->trans)) + return true; + + dsc_for_each_psoc_vdev(psoc, vdev) { + if (__dsc_trans_active(&vdev->trans)) + return true; + } + } + + return false; +} + +static bool __dsc_driver_can_op(struct dsc_driver *driver) +{ + return !__dsc_trans_active_or_queued(&driver->trans); +} + +static bool __dsc_driver_can_trans(struct dsc_driver *driver) +{ + return !__dsc_trans_active_or_queued(&driver->trans) && + !__dsc_driver_trans_active_down_tree(driver); +} + +static bool __dsc_driver_can_trigger(struct dsc_driver *driver) +{ + return !__dsc_trans_active(&driver->trans) && + !__dsc_driver_trans_active_down_tree(driver); +} + +static QDF_STATUS +__dsc_driver_trans_start_nolock(struct dsc_driver *driver, const char *desc) +{ + if (!__dsc_driver_can_trans(driver)) + return QDF_STATUS_E_AGAIN; + + driver->trans.active_desc = desc; + + return QDF_STATUS_SUCCESS; +} + +static QDF_STATUS +__dsc_driver_trans_start(struct dsc_driver *driver, const char *desc) +{ + QDF_STATUS status; + + if (!dsc_assert(driver)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(desc)) + return QDF_STATUS_E_INVAL; + + __dsc_lock(); + status = __dsc_driver_trans_start_nolock(driver, desc); + __dsc_unlock(); + + return status; +} + +QDF_STATUS dsc_driver_trans_start(struct dsc_driver *driver, const char *desc) +{ + QDF_STATUS status; + + dsc_enter_str(desc); + status = __dsc_driver_trans_start(driver, desc); + dsc_exit_status(status); + + return status; +} + +static QDF_STATUS +__dsc_driver_trans_start_wait(struct dsc_driver *driver, const char *desc) +{ + QDF_STATUS status; + struct dsc_tran tran = { 0 }; + + if (!dsc_assert(driver)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(desc)) + return QDF_STATUS_E_INVAL; + + __dsc_lock(); + + status = __dsc_driver_trans_start_nolock(driver, desc); + if (QDF_IS_STATUS_SUCCESS(status)) { + __dsc_unlock(); + return QDF_STATUS_SUCCESS; + } + + __dsc_trans_queue(&driver->trans, &tran, desc); + + __dsc_unlock(); + + return __dsc_tran_wait(&tran); +} + +QDF_STATUS +dsc_driver_trans_start_wait(struct dsc_driver *driver, const char *desc) +{ + QDF_STATUS status; + + dsc_enter_str(desc); + status = __dsc_driver_trans_start_wait(driver, desc); + dsc_exit_status(status); + + return status; +} + +bool __dsc_driver_trans_trigger_checked(struct dsc_driver *driver) +{ + if (!__dsc_trans_queued(&driver->trans)) + return false; + + /* handled, but don't trigger; we need to wait for more children */ + if (!__dsc_driver_can_trigger(driver)) + return true; + + return __dsc_trans_trigger(&driver->trans); +} + +static void __dsc_driver_trigger_trans(struct dsc_driver *driver) +{ + struct dsc_psoc *psoc; + struct dsc_vdev *vdev; + + if (__dsc_trans_trigger(&driver->trans)) + return; + + dsc_for_each_driver_psoc(driver, psoc) { + if (__dsc_trans_trigger(&psoc->trans)) + continue; + + dsc_for_each_psoc_vdev(psoc, vdev) + __dsc_trans_trigger(&vdev->trans); + } +} + +static void __dsc_driver_trans_stop(struct dsc_driver *driver) +{ + if (!dsc_assert(driver)) + return; + + dsc_assert(driver->trans.active_desc); + driver->trans.active_desc = NULL; + + __dsc_driver_trigger_trans(driver); +} + +void dsc_driver_trans_stop(struct dsc_driver *driver) +{ + dsc_enter(); + __dsc_lock(); + __dsc_driver_trans_stop(driver); + __dsc_unlock(); + dsc_exit(); +} + +void dsc_driver_trans_assert(struct dsc_driver *driver) +{ + dsc_enter(); + __dsc_lock(); + dsc_assert(driver->trans.active_desc); + __dsc_unlock(); + dsc_exit(); +} + +static QDF_STATUS +__dsc_driver_op_start(struct dsc_driver *driver, const char *func) +{ + if (!dsc_assert(driver)) + return QDF_STATUS_E_INVAL; + + if (!dsc_assert(func)) + return QDF_STATUS_E_INVAL; + + if (!__dsc_driver_can_op(driver)) + return QDF_STATUS_E_AGAIN; + + return __dsc_ops_insert(&driver->ops, func); +} + +QDF_STATUS _dsc_driver_op_start(struct dsc_driver *driver, const char *func) +{ + QDF_STATUS status; + + dsc_enter_str(func); + __dsc_lock(); + status = __dsc_driver_op_start(driver, func); + __dsc_unlock(); + dsc_exit_status(status); + + return status; +} + +static void __dsc_driver_op_stop(struct dsc_driver *driver, const char *func) +{ + if (!dsc_assert(driver)) + return; + + if (!dsc_assert(func)) + return; + + if (__dsc_ops_remove(&driver->ops, func)) + qdf_event_set(&driver->ops.event); +} + +void _dsc_driver_op_stop(struct dsc_driver *driver, const char *func) +{ + dsc_enter_str(func); + __dsc_lock(); + __dsc_driver_op_stop(driver, func); + __dsc_unlock(); + dsc_exit(); +} + +static void __dsc_driver_wait_for_ops(struct dsc_driver *driver) +{ + struct dsc_psoc *psoc; + bool wait; + + if (!dsc_assert(driver)) + return; + + __dsc_lock(); + + /* flushing without preventing new ops is almost certainly a bug */ + dsc_assert(!__dsc_driver_can_op(driver)); + + wait = driver->ops.count > 0; + if (wait) + qdf_event_reset(&driver->ops.event); + + __dsc_unlock(); + + if (wait) + qdf_wait_single_event(&driver->ops.event, 0); + + /* wait for down-tree ops to complete as well */ + dsc_for_each_driver_psoc(driver, psoc) + dsc_psoc_wait_for_ops(psoc); +} + +void dsc_driver_wait_for_ops(struct dsc_driver *driver) +{ + dsc_enter(); + __dsc_driver_wait_for_ops(driver); + dsc_exit(); +} +