| Message ID | 20210128170936.9222-3-mike.leach@linaro.org (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | CoreSight configuration management; ETM strobing | expand |
[...] > +/** > + * List entry for Coresight devices that are registered as supporting complex > + * config operations. > + * > + * @csdev: The registered device. > + * @match_info: The matching type information. > + * @ops: Operations supported by the registered device. > + * @item: list entry. > + */ > +struct cscfg_csdev_register { > + struct coresight_device *csdev; > + struct cscfg_match_desc match_info; > + struct cscfg_csdev_feat_ops ops; > + struct list_head item; > +}; I would call this structure cscfg_registered_csdev and move it to coresight-config.h. That way it is consistent with cscfg_config_csdev and cscfg_feature_csdev and located all in the same file. I may have to come back to this patch but for now it holds together. More comments to come on Monday. Thanks, Mathieu > + > /* internal core operations for cscfg */ > int __init cscfg_init(void); > void __exit cscfg_exit(void); > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > /* syscfg manager external API */ > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > struct cscfg_feature_desc **feat_descs); > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops); > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > /** > * System configuration manager device. > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > index 976ec2697610..d0126ed326a6 100644 > --- a/include/linux/coresight.h > +++ b/include/linux/coresight.h > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > * @nr_links: number of sysfs links created to other components from this > * device. These will appear in the "connections" group. > * @has_conns_grp: Have added a "connections" group for sysfs links. > + * @feature_csdev_list: List of complex feature programming added to the device. > + * @config_csdev_list: List of system configurations added to the device. > */ > struct coresight_device { > struct coresight_platform_data *pdata; > @@ -240,6 +242,9 @@ struct coresight_device { > int nr_links; > bool has_conns_grp; > bool ect_enabled; /* true only if associated ect device is enabled */ > + /* system configuration and feature lists */ > + struct list_head feature_csdev_list; > + struct list_head config_csdev_list; > }; > > /* > -- > 2.17.1 >
Hi Mike, On Thu, Jan 28, 2021 at 05:09:28PM +0000, Mike Leach wrote: > API for individual devices to register with the syscfg management > system is added. > > Devices register with matching information, and any features or > configurations that match will be loaded into the device. > > The feature and configuration loading is extended so that on load these > are loaded into any currently registered devices. This allows > configuration loading after devices have been registered. > > Signed-off-by: Mike Leach <mike.leach@linaro.org> > --- > .../hwtracing/coresight/coresight-config.h | 98 +++++ > .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ > .../hwtracing/coresight/coresight-syscfg.h | 20 + > include/linux/coresight.h | 5 + > 4 files changed, 471 insertions(+) > > diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h > index 3fedf8ab3cee..75ecdecf7013 100644 > --- a/drivers/hwtracing/coresight/coresight-config.h > +++ b/drivers/hwtracing/coresight/coresight-config.h > @@ -164,4 +164,102 @@ struct cscfg_config_desc { > const u64 *presets; /* nr_presets * nr_total_params */ > }; > > +/** > + * config register instance - part of a loaded feature. > + * maps register values to csdev driver structures > + * > + * @value: value to use when setting feature on device / store for > + * readback of volatile values. > + * @drv_store: pointer to internal driver element used to set the value > + * in hardware. > + */ > +struct cscfg_reg_csdev { Please rename this cscfg_regval_csdev to highlight the 1:1 mapping with cscfg_regval_desc. Or rename cscfg_regval_desc to cscfg_reg_desc. I have no opinion on which one it should be, as long as they are consistent. Doing so really helps getting over the naming convention so that we can focus on the core of the feature. > + struct cscfg_regval_desc value; > + void *drv_store; > +}; > + > +/** > + * config parameter instance - part of a loaded feature. > + * > + * @feat: parent feature > + * @reg: register value updated by this parameter. > + * @current_value: current value of parameter - may be set by user via > + * sysfs, or modified during device operation. > + * @val64: true if 64 bit value > + */ > +struct cscfg_parameter_csdev { > + struct cscfg_feature_csdev *feat; > + struct cscfg_reg_csdev *reg; > + u64 current_value; > + bool val64; > +}; > + > +/** > + * Feature instance loaded into a CoreSight device. > + * > + * When a feature is loaded into a specific device, then this structure holds > + * the connections between the register / parameter values used and the > + * internal data structures that are written when the feature is enabled. > + * > + * Since applying a feature modifies internal data structures in the device, > + * then we have a reference to the device spinlock to protect access to these > + * structures (@csdev_spinlock). > + * > + * @desc: pointer to the static descriptor for this feature. > + * @csdev: parent CoreSight device instance. > + * @node: list entry into feature list for this device. > + * @csdev_spinlock: device spinlock from csdev instance.. > + * @nr_params: number of parameters. > + * @params: current parameter values on this device > + * @nr_regs: number of registers to be programmed. > + * @regs: Programming details for the registers > + */ > +struct cscfg_feature_csdev { > + const struct cscfg_feature_desc *desc; > + struct coresight_device *csdev; > + struct list_head node; > + spinlock_t *csdev_spinlock; > + int nr_params; > + struct cscfg_parameter_csdev *params; > + int nr_regs; > + struct cscfg_reg_csdev *regs; > +}; > + > +/** > + * Configuration instance when loaded into a CoreSight device. > + * > + * The instance contains references to loaded features on this device that are > + * used by the configuration. > + * > + * @desc: reference to the descriptor for this configuration > + * @csdev: parent coresight device for this configuration instance. > + * @node: list entry within the coresight device > + * @nr_feat: Number of features on this device that are used in the > + * configuration. > + * @feats: reference to the device features to enable. > + * @enabled: true if configuration is enabled on this device. > + */ > +struct cscfg_config_csdev { > + const struct cscfg_config_desc *desc; > + struct coresight_device *csdev; > + struct list_head node; > + int nr_feat; > + struct cscfg_feature_csdev **feats; > + bool enabled; > +}; > + > +/** > + * Coresight device operations. > + * > + * Registered coresight devices provide these operations to manage feature > + * instances compatible with the device hardware and drivers > + * > + * @load_feat: Pass a feature descriptor into the device and create the > + * loaded feature instance (struct cscfg_feature_csdev). > + */ > +struct cscfg_csdev_feat_ops { > + int (*load_feat)(struct coresight_device *csdev, > + struct cscfg_feature_csdev *feat); > +}; > + > #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c > index f7e396a5f9cb..c04cea0c1db2 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.c > +++ b/drivers/hwtracing/coresight/coresight-syscfg.c > @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; > > /* load features and configuations into the lists */ > > +/* protect the cfg lists in the csdev instances */ > +static DEFINE_MUTEX(cscfg_csdev_mutex); > + > +/* get name feature instance from a coresight device list of features */ > +static struct cscfg_feature_csdev * > +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) > +{ > + struct cscfg_feature_csdev *feat = NULL; > + > + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { > + if (strcmp(feat->desc->name, name) == 0) > + return feat; > + } > + return NULL; > +} > + > +/* allocate the device config instance - with max number of used features */ > +static struct cscfg_config_csdev * > +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; > + struct device *dev = csdev->dev.parent; > + > + /* this is being allocated using the devm for the coresight device */ > + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); > + if (!dev_cfg) > + return NULL; > + > + dev_cfg->csdev = csdev; > + dev_cfg->feats = devm_kcalloc(dev, nr_feats, > + sizeof(struct cscfg_feature_csdev *), > + GFP_KERNEL); > + if (!dev_cfg->feats) > + dev_cfg = NULL; > + return dev_cfg; > +} > + > +/* check match info between used feature from the config and a regisered device */ > +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, > + struct cscfg_match_desc *reg_dev) > +{ > + /* if flags don't match then fail early */ > + if (!(used_cmp->match_flags & reg_dev->match_flags)) > + return false; > + > + return true; > +} > + > +/* Load a config into a device if there are feature matches between config and device */ > +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, > + struct cscfg_match_desc *match_info, > + struct cscfg_config_desc *cfg_desc) struct cscfg_config_desc *config_desc) > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; struct cscfg_config_csdev *config_csdev = NULL; > + struct cscfg_config_feat_ref *feat_ref; > + struct cscfg_feature_csdev *feat; struct cscfg_feature_csdev *feat_csdev; Please appy this kind of naming convention throughout the patchset. > + int checked; > + > + /* look at each required feature and see if it matches any feature on the device */ > + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { > + feat_ref = &cfg_desc->refs[checked]; > + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { > + /* device matched - get the feature */ > + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); > + if (!feat) > + return -EINVAL; > + if (!dev_cfg) { > + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); > + if (!dev_cfg) > + return -ENOMEM; > + dev_cfg->desc = cfg_desc; > + } > + dev_cfg->feats[dev_cfg->nr_feat++] = feat; > + } > + } > + /* if matched features, add config to device.*/ > + if (dev_cfg) { > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&dev_cfg->node, &csdev->config_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + } > + > + return 0; > +} > + > +/* > + * Add the config to the set of registered devices - call with mutex locked. > + * Iterates through devices - any device that matches one or more of the > + * configuration features will load it, the others will ignore it. > + */ > +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) > +{ > + struct cscfg_csdev_register *curr_item; > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); > + if (err) > + return err; > + } > + return 0; > +} > + > +/* > + * Allocate a feature object for load into a csdev. > + * memory allocated using the csdev->dev object using devm managed allocator. > + */ > +static struct cscfg_feature_csdev * > +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_feature_csdev *feat = NULL; struct cscfg_feature_csdev *feat_csdev = NULL; > + struct device *dev = csdev->dev.parent; > + int i; > + > + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); > + if (!feat) > + return NULL; > + > + /* parameters are optional - could be 0 */ > + feat->nr_params = feat_desc->nr_params; > + > + /* > + * if we need parameters, zero alloc the space here, the load routine in > + * the csdev device driver will fill out some information according to > + * feature descriptor. > + */ > + if (feat->nr_params) { > + feat->params = devm_kcalloc(dev, feat->nr_params, > + sizeof(struct cscfg_parameter_csdev), > + GFP_KERNEL); > + if (!feat->params) > + return NULL; > + > + /* > + * fill in the feature reference in the param - other fields > + * handled by loader in csdev. > + */ > + for (i = 0; i < feat->nr_params; i++) > + feat->params[i].feat = feat; > + } > + > + /* > + * Always have registers to program - again the load routine in csdev device > + * will fill out according to feature descriptor and device requirements. > + */ > + feat->nr_regs = feat_desc->nr_regs; > + feat->regs = devm_kcalloc(dev, feat->nr_regs, > + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); > + if (!feat->regs) > + return NULL; > + > + /* load the feature default values */ > + feat->desc = feat_desc; > + feat->csdev = csdev; > + > + return feat; > +} > + > +/* load one feature into one coresight device */ > +static int cscfg_load_feat_csdev(struct coresight_device *csdev, > + struct cscfg_feature_desc *feat_desc, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_csdev *feat_csdev; > + int err; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); > + if (!feat_csdev) > + return -ENOMEM; > + > + /* load the feature into the device - may modify default ops*/ > + err = ops->load_feat(csdev, feat_csdev); > + if (err) > + return err; > + > + /* add to internal csdev feature list */ > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&feat_csdev->node, &csdev->feature_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + > + return 0; > +} > + > +/* > + * Add feature to any matching devices - call with mutex locked. > + * Iterates through devices - any device that matches the feature will be > + * called to load it. > + */ > +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_csdev_register *curr_item; > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->match_info.match_flags & feat_desc->match_flags) { > + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); > + if (err) > + return err; > + } > + } > + return 0; > +} > + > /* check feature list for a named feature - call with mutex locked. */ > static bool cscfg_match_list_feat(const char *name) > { > @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) > */ > static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) > { > + int err; > + > + /* add feature to any matching registered devices */ > + err = cscfg_add_feat_to_csdevs(feat_desc); > + if (err) > + return err; > + > list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); > > return 0; > @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) > if (err) > return err; > > + /* add config to any matching registered device */ > + err = cscfg_add_cfg_to_csdevs(cfg_desc); > + if (err) > + return err; > + > list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); > > return 0; > @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > } > EXPORT_SYMBOL_GPL(cscfg_load_config_sets); > > +/* Handle coresight device registration and add configs and features to devices */ > + > +/* iterate through config lists and load matching configs to device */ > +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info) > +{ > + struct cscfg_config_desc *curr_item; > + int err = 0; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { > + err = cscfg_add_csdev_cfg(csdev, info, curr_item); > + if (err) > + break; > + } > + return err; > +} > + > +/* iterate through feature lists and load matching features to device */ > +static int cscfg_add_feats_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_desc *curr_item; > + int err = 0; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { > + if (curr_item->match_flags & info->match_flags) { > + err = cscfg_load_feat_csdev(csdev, curr_item, ops); > + if (err) > + break; > + } > + } > + return err; > +} > + > +/* Add coresight device to list and copy its matching info */ > +static int cscfg_list_add_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_csdev_register *list_entry; > + > + /* allocate the list entry structure */ > + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); > + if (!list_entry) > + return -ENOMEM; > + > + list_entry->csdev = csdev; > + list_entry->match_info.match_flags = info->match_flags; > + list_entry->ops.load_feat = ops->load_feat; > + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); > + > + INIT_LIST_HEAD(&csdev->feature_csdev_list); > + INIT_LIST_HEAD(&csdev->config_csdev_list); > + cscfg_mgr->data.nr_csdev++; > + > + return 0; > +} > + > +/* remove a coresight device from the list and free data */ > +static void cscfg_list_remove_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; > + > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > +} > + > +/* register a coresight device with the syscfg api */ > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + int ret = 0; > + > + mutex_lock(&cscfg_mutex); > + > + /* add device to list of registered devices */ > + ret = cscfg_list_add_csdev(csdev, info, ops); > + if (ret) > + goto reg_csdev_unlock; > + > + /* now load any registered features and configs matching the device. */ > + ret = cscfg_add_feats_csdev(csdev, info, ops); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + ret = cscfg_add_cfgs_csdev(csdev, info); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); > + > +reg_csdev_unlock: > + mutex_unlock(&cscfg_mutex); > + return ret; > +} > +EXPORT_SYMBOL_GPL(cscfg_register_csdev); > + > +/* remove coresight device and update counts - syscfg device at 0 */ > +void cscfg_unregister_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; > + > + mutex_lock(&cscfg_mutex); > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > + mutex_unlock(&cscfg_mutex); > +} > +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); > + > /* Initialise system configuration management device. */ > > struct device *to_device_cscfg(void) > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h > index 907ba8d3efea..ebf5e1491d86 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.h > +++ b/drivers/hwtracing/coresight/coresight-syscfg.h > @@ -26,6 +26,22 @@ struct cscfg_api_data { > int nr_csdev; > }; > > +/** > + * List entry for Coresight devices that are registered as supporting complex > + * config operations. > + * > + * @csdev: The registered device. > + * @match_info: The matching type information. > + * @ops: Operations supported by the registered device. > + * @item: list entry. > + */ > +struct cscfg_csdev_register { > + struct coresight_device *csdev; > + struct cscfg_match_desc match_info; > + struct cscfg_csdev_feat_ops ops; > + struct list_head item; > +}; > + > /* internal core operations for cscfg */ > int __init cscfg_init(void); > void __exit cscfg_exit(void); > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > /* syscfg manager external API */ > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > struct cscfg_feature_desc **feat_descs); > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops); > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > /** > * System configuration manager device. > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > index 976ec2697610..d0126ed326a6 100644 > --- a/include/linux/coresight.h > +++ b/include/linux/coresight.h > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > * @nr_links: number of sysfs links created to other components from this > * device. These will appear in the "connections" group. > * @has_conns_grp: Have added a "connections" group for sysfs links. > + * @feature_csdev_list: List of complex feature programming added to the device. > + * @config_csdev_list: List of system configurations added to the device. > */ > struct coresight_device { > struct coresight_platform_data *pdata; > @@ -240,6 +242,9 @@ struct coresight_device { > int nr_links; > bool has_conns_grp; > bool ect_enabled; /* true only if associated ect device is enabled */ > + /* system configuration and feature lists */ > + struct list_head feature_csdev_list; > + struct list_head config_csdev_list; > }; > > /* > -- > 2.17.1 >
On Thu, Jan 28, 2021 at 05:09:28PM +0000, Mike Leach wrote: > API for individual devices to register with the syscfg management > system is added. > > Devices register with matching information, and any features or > configurations that match will be loaded into the device. > > The feature and configuration loading is extended so that on load these > are loaded into any currently registered devices. This allows > configuration loading after devices have been registered. > > Signed-off-by: Mike Leach <mike.leach@linaro.org> > --- > .../hwtracing/coresight/coresight-config.h | 98 +++++ > .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ > .../hwtracing/coresight/coresight-syscfg.h | 20 + > include/linux/coresight.h | 5 + > 4 files changed, 471 insertions(+) > > diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h > index 3fedf8ab3cee..75ecdecf7013 100644 > --- a/drivers/hwtracing/coresight/coresight-config.h > +++ b/drivers/hwtracing/coresight/coresight-config.h > @@ -164,4 +164,102 @@ struct cscfg_config_desc { > const u64 *presets; /* nr_presets * nr_total_params */ > }; > > +/** > + * config register instance - part of a loaded feature. > + * maps register values to csdev driver structures > + * > + * @value: value to use when setting feature on device / store for > + * readback of volatile values. > + * @drv_store: pointer to internal driver element used to set the value > + * in hardware. > + */ > +struct cscfg_reg_csdev { > + struct cscfg_regval_desc value; struct cscfg_regval_desc reg_desc; > + void *drv_store; > +}; > + > +/** > + * config parameter instance - part of a loaded feature. > + * > + * @feat: parent feature > + * @reg: register value updated by this parameter. > + * @current_value: current value of parameter - may be set by user via > + * sysfs, or modified during device operation. > + * @val64: true if 64 bit value > + */ > +struct cscfg_parameter_csdev { > + struct cscfg_feature_csdev *feat; struct cscfg_feature_csdev *feat_csdev; > + struct cscfg_reg_csdev *reg; struct cscfg_reg_csdev *reg_csdev; > + u64 current_value; > + bool val64; > +}; > + > +/** > + * Feature instance loaded into a CoreSight device. > + * > + * When a feature is loaded into a specific device, then this structure holds > + * the connections between the register / parameter values used and the > + * internal data structures that are written when the feature is enabled. > + * > + * Since applying a feature modifies internal data structures in the device, > + * then we have a reference to the device spinlock to protect access to these > + * structures (@csdev_spinlock). > + * > + * @desc: pointer to the static descriptor for this feature. > + * @csdev: parent CoreSight device instance. > + * @node: list entry into feature list for this device. > + * @csdev_spinlock: device spinlock from csdev instance.. > + * @nr_params: number of parameters. > + * @params: current parameter values on this device > + * @nr_regs: number of registers to be programmed. > + * @regs: Programming details for the registers > + */ > +struct cscfg_feature_csdev { > + const struct cscfg_feature_desc *desc; const struct cscfg_feature_desc *feat_desc; > + struct coresight_device *csdev; > + struct list_head node; > + spinlock_t *csdev_spinlock; > + int nr_params; > + struct cscfg_parameter_csdev *params; struct cscfg_parameter_csdev *params_csdev; > + int nr_regs; > + struct cscfg_reg_csdev *regs; struct cscfg_reg_csdev *regs_csdev; > +}; > + > +/** > + * Configuration instance when loaded into a CoreSight device. > + * > + * The instance contains references to loaded features on this device that are > + * used by the configuration. > + * > + * @desc: reference to the descriptor for this configuration > + * @csdev: parent coresight device for this configuration instance. > + * @node: list entry within the coresight device > + * @nr_feat: Number of features on this device that are used in the > + * configuration. > + * @feats: reference to the device features to enable. > + * @enabled: true if configuration is enabled on this device. > + */ > +struct cscfg_config_csdev { > + const struct cscfg_config_desc *desc; const struct cscfg_config_desc *cfg_desc; > + struct coresight_device *csdev; > + struct list_head node; > + int nr_feat; > + struct cscfg_feature_csdev **feats; struct cscfg_feature_csdev **feat_csdev; > + bool enabled; > +}; > + > +/** > + * Coresight device operations. > + * > + * Registered coresight devices provide these operations to manage feature > + * instances compatible with the device hardware and drivers > + * > + * @load_feat: Pass a feature descriptor into the device and create the > + * loaded feature instance (struct cscfg_feature_csdev). > + */ > +struct cscfg_csdev_feat_ops { > + int (*load_feat)(struct coresight_device *csdev, > + struct cscfg_feature_csdev *feat); struct cscfg_feature_csdev *feat_csdev); Please pick the same convention for naming structure throughout the entire patchset for declaration and function parameters. I know it is a lot of modifications but it is the only way I can concentrate on the feature being added without having to constantly go back to the header files. Thanks, Mathieu > +}; > + > #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c > index f7e396a5f9cb..c04cea0c1db2 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.c > +++ b/drivers/hwtracing/coresight/coresight-syscfg.c > @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; > > /* load features and configuations into the lists */ > > +/* protect the cfg lists in the csdev instances */ > +static DEFINE_MUTEX(cscfg_csdev_mutex); > + > +/* get name feature instance from a coresight device list of features */ > +static struct cscfg_feature_csdev * > +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) > +{ > + struct cscfg_feature_csdev *feat = NULL; > + > + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { > + if (strcmp(feat->desc->name, name) == 0) > + return feat; > + } > + return NULL; > +} > + > +/* allocate the device config instance - with max number of used features */ > +static struct cscfg_config_csdev * > +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; > + struct device *dev = csdev->dev.parent; > + > + /* this is being allocated using the devm for the coresight device */ > + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); > + if (!dev_cfg) > + return NULL; > + > + dev_cfg->csdev = csdev; > + dev_cfg->feats = devm_kcalloc(dev, nr_feats, > + sizeof(struct cscfg_feature_csdev *), > + GFP_KERNEL); > + if (!dev_cfg->feats) > + dev_cfg = NULL; > + return dev_cfg; > +} > + > +/* check match info between used feature from the config and a regisered device */ > +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, > + struct cscfg_match_desc *reg_dev) > +{ > + /* if flags don't match then fail early */ > + if (!(used_cmp->match_flags & reg_dev->match_flags)) > + return false; > + > + return true; > +} > + > +/* Load a config into a device if there are feature matches between config and device */ > +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, > + struct cscfg_match_desc *match_info, > + struct cscfg_config_desc *cfg_desc) > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; > + struct cscfg_config_feat_ref *feat_ref; > + struct cscfg_feature_csdev *feat; > + int checked; > + > + /* look at each required feature and see if it matches any feature on the device */ > + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { > + feat_ref = &cfg_desc->refs[checked]; > + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { > + /* device matched - get the feature */ > + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); > + if (!feat) > + return -EINVAL; > + if (!dev_cfg) { > + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); > + if (!dev_cfg) > + return -ENOMEM; > + dev_cfg->desc = cfg_desc; > + } > + dev_cfg->feats[dev_cfg->nr_feat++] = feat; > + } > + } > + /* if matched features, add config to device.*/ > + if (dev_cfg) { > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&dev_cfg->node, &csdev->config_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + } > + > + return 0; > +} > + > +/* > + * Add the config to the set of registered devices - call with mutex locked. > + * Iterates through devices - any device that matches one or more of the > + * configuration features will load it, the others will ignore it. > + */ > +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) > +{ > + struct cscfg_csdev_register *curr_item; > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); > + if (err) > + return err; > + } > + return 0; > +} > + > +/* > + * Allocate a feature object for load into a csdev. > + * memory allocated using the csdev->dev object using devm managed allocator. > + */ > +static struct cscfg_feature_csdev * > +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_feature_csdev *feat = NULL; > + struct device *dev = csdev->dev.parent; > + int i; > + > + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); > + if (!feat) > + return NULL; > + > + /* parameters are optional - could be 0 */ > + feat->nr_params = feat_desc->nr_params; > + > + /* > + * if we need parameters, zero alloc the space here, the load routine in > + * the csdev device driver will fill out some information according to > + * feature descriptor. > + */ > + if (feat->nr_params) { > + feat->params = devm_kcalloc(dev, feat->nr_params, > + sizeof(struct cscfg_parameter_csdev), > + GFP_KERNEL); > + if (!feat->params) > + return NULL; > + > + /* > + * fill in the feature reference in the param - other fields > + * handled by loader in csdev. > + */ > + for (i = 0; i < feat->nr_params; i++) > + feat->params[i].feat = feat; > + } > + > + /* > + * Always have registers to program - again the load routine in csdev device > + * will fill out according to feature descriptor and device requirements. > + */ > + feat->nr_regs = feat_desc->nr_regs; > + feat->regs = devm_kcalloc(dev, feat->nr_regs, > + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); > + if (!feat->regs) > + return NULL; > + > + /* load the feature default values */ > + feat->desc = feat_desc; > + feat->csdev = csdev; > + > + return feat; > +} > + > +/* load one feature into one coresight device */ > +static int cscfg_load_feat_csdev(struct coresight_device *csdev, > + struct cscfg_feature_desc *feat_desc, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_csdev *feat_csdev; > + int err; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); > + if (!feat_csdev) > + return -ENOMEM; > + > + /* load the feature into the device - may modify default ops*/ > + err = ops->load_feat(csdev, feat_csdev); > + if (err) > + return err; > + > + /* add to internal csdev feature list */ > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&feat_csdev->node, &csdev->feature_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + > + return 0; > +} > + > +/* > + * Add feature to any matching devices - call with mutex locked. > + * Iterates through devices - any device that matches the feature will be > + * called to load it. > + */ > +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_csdev_register *curr_item; > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->match_info.match_flags & feat_desc->match_flags) { > + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); > + if (err) > + return err; > + } > + } > + return 0; > +} > + > /* check feature list for a named feature - call with mutex locked. */ > static bool cscfg_match_list_feat(const char *name) > { > @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) > */ > static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) > { > + int err; > + > + /* add feature to any matching registered devices */ > + err = cscfg_add_feat_to_csdevs(feat_desc); > + if (err) > + return err; > + > list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); > > return 0; > @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) > if (err) > return err; > > + /* add config to any matching registered device */ > + err = cscfg_add_cfg_to_csdevs(cfg_desc); > + if (err) > + return err; > + > list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); > > return 0; > @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > } > EXPORT_SYMBOL_GPL(cscfg_load_config_sets); > > +/* Handle coresight device registration and add configs and features to devices */ > + > +/* iterate through config lists and load matching configs to device */ > +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info) > +{ > + struct cscfg_config_desc *curr_item; > + int err = 0; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { > + err = cscfg_add_csdev_cfg(csdev, info, curr_item); > + if (err) > + break; > + } > + return err; > +} > + > +/* iterate through feature lists and load matching features to device */ > +static int cscfg_add_feats_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_desc *curr_item; > + int err = 0; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { > + if (curr_item->match_flags & info->match_flags) { > + err = cscfg_load_feat_csdev(csdev, curr_item, ops); > + if (err) > + break; > + } > + } > + return err; > +} > + > +/* Add coresight device to list and copy its matching info */ > +static int cscfg_list_add_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_csdev_register *list_entry; > + > + /* allocate the list entry structure */ > + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); > + if (!list_entry) > + return -ENOMEM; > + > + list_entry->csdev = csdev; > + list_entry->match_info.match_flags = info->match_flags; > + list_entry->ops.load_feat = ops->load_feat; > + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); > + > + INIT_LIST_HEAD(&csdev->feature_csdev_list); > + INIT_LIST_HEAD(&csdev->config_csdev_list); > + cscfg_mgr->data.nr_csdev++; > + > + return 0; > +} > + > +/* remove a coresight device from the list and free data */ > +static void cscfg_list_remove_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; > + > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > +} > + > +/* register a coresight device with the syscfg api */ > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + int ret = 0; > + > + mutex_lock(&cscfg_mutex); > + > + /* add device to list of registered devices */ > + ret = cscfg_list_add_csdev(csdev, info, ops); > + if (ret) > + goto reg_csdev_unlock; > + > + /* now load any registered features and configs matching the device. */ > + ret = cscfg_add_feats_csdev(csdev, info, ops); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + ret = cscfg_add_cfgs_csdev(csdev, info); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); > + > +reg_csdev_unlock: > + mutex_unlock(&cscfg_mutex); > + return ret; > +} > +EXPORT_SYMBOL_GPL(cscfg_register_csdev); > + > +/* remove coresight device and update counts - syscfg device at 0 */ > +void cscfg_unregister_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; > + > + mutex_lock(&cscfg_mutex); > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > + mutex_unlock(&cscfg_mutex); > +} > +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); > + > /* Initialise system configuration management device. */ > > struct device *to_device_cscfg(void) > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h > index 907ba8d3efea..ebf5e1491d86 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.h > +++ b/drivers/hwtracing/coresight/coresight-syscfg.h > @@ -26,6 +26,22 @@ struct cscfg_api_data { > int nr_csdev; > }; > > +/** > + * List entry for Coresight devices that are registered as supporting complex > + * config operations. > + * > + * @csdev: The registered device. > + * @match_info: The matching type information. > + * @ops: Operations supported by the registered device. > + * @item: list entry. > + */ > +struct cscfg_csdev_register { > + struct coresight_device *csdev; > + struct cscfg_match_desc match_info; > + struct cscfg_csdev_feat_ops ops; > + struct list_head item; > +}; > + > /* internal core operations for cscfg */ > int __init cscfg_init(void); > void __exit cscfg_exit(void); > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > /* syscfg manager external API */ > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > struct cscfg_feature_desc **feat_descs); > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops); > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > /** > * System configuration manager device. > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > index 976ec2697610..d0126ed326a6 100644 > --- a/include/linux/coresight.h > +++ b/include/linux/coresight.h > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > * @nr_links: number of sysfs links created to other components from this > * device. These will appear in the "connections" group. > * @has_conns_grp: Have added a "connections" group for sysfs links. > + * @feature_csdev_list: List of complex feature programming added to the device. > + * @config_csdev_list: List of system configurations added to the device. > */ > struct coresight_device { > struct coresight_platform_data *pdata; > @@ -240,6 +242,9 @@ struct coresight_device { > int nr_links; > bool has_conns_grp; > bool ect_enabled; /* true only if associated ect device is enabled */ > + /* system configuration and feature lists */ > + struct list_head feature_csdev_list; > + struct list_head config_csdev_list; > }; > > /* > -- > 2.17.1 >
Hi Mathieu, On Fri, 19 Feb 2021 at 18:43, Mathieu Poirier <mathieu.poirier@linaro.org> wrote: > > [...] > > > +/** > > + * List entry for Coresight devices that are registered as supporting complex > > + * config operations. > > + * > > + * @csdev: The registered device. > > + * @match_info: The matching type information. > > + * @ops: Operations supported by the registered device. > > + * @item: list entry. > > + */ > > +struct cscfg_csdev_register { > > + struct coresight_device *csdev; > > + struct cscfg_match_desc match_info; > > + struct cscfg_csdev_feat_ops ops; > > + struct list_head item; > > +}; > > I would call this structure cscfg_registered_csdev and move it to > coresight-config.h. That way it is consistent with cscfg_config_csdev and > cscfg_feature_csdev and located all in the same file. > I was trying to separate structures that are used to define configurations and features, with those that are used to manage the same. Hence, most things in coresight_config.h define configurations, or their device loaded instance equivalents, and things in coresight_syscfg.h are management items. I am happy to change the name but would prefer is stay in coresight_syscfg.h Thanks Mike > I may have to come back to this patch but for now it holds together. > > More comments to come on Monday. > > Thanks, > Mathieu > > > + > > /* internal core operations for cscfg */ > > int __init cscfg_init(void); > > void __exit cscfg_exit(void); > > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > > /* syscfg manager external API */ > > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > > struct cscfg_feature_desc **feat_descs); > > +int cscfg_register_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops); > > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > > > /** > > * System configuration manager device. > > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > > index 976ec2697610..d0126ed326a6 100644 > > --- a/include/linux/coresight.h > > +++ b/include/linux/coresight.h > > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > > * @nr_links: number of sysfs links created to other components from this > > * device. These will appear in the "connections" group. > > * @has_conns_grp: Have added a "connections" group for sysfs links. > > + * @feature_csdev_list: List of complex feature programming added to the device. > > + * @config_csdev_list: List of system configurations added to the device. > > */ > > struct coresight_device { > > struct coresight_platform_data *pdata; > > @@ -240,6 +242,9 @@ struct coresight_device { > > int nr_links; > > bool has_conns_grp; > > bool ect_enabled; /* true only if associated ect device is enabled */ > > + /* system configuration and feature lists */ > > + struct list_head feature_csdev_list; > > + struct list_head config_csdev_list; > > }; > > > > /* > > -- > > 2.17.1 > >
Hi Mathieu, On Mon, 22 Feb 2021 at 17:38, Mathieu Poirier <mathieu.poirier@linaro.org> wrote: > > Hi Mike, > > On Thu, Jan 28, 2021 at 05:09:28PM +0000, Mike Leach wrote: > > API for individual devices to register with the syscfg management > > system is added. > > > > Devices register with matching information, and any features or > > configurations that match will be loaded into the device. > > > > The feature and configuration loading is extended so that on load these > > are loaded into any currently registered devices. This allows > > configuration loading after devices have been registered. > > > > Signed-off-by: Mike Leach <mike.leach@linaro.org> > > --- > > .../hwtracing/coresight/coresight-config.h | 98 +++++ > > .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ > > .../hwtracing/coresight/coresight-syscfg.h | 20 + > > include/linux/coresight.h | 5 + > > 4 files changed, 471 insertions(+) > > > > diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h > > index 3fedf8ab3cee..75ecdecf7013 100644 > > --- a/drivers/hwtracing/coresight/coresight-config.h > > +++ b/drivers/hwtracing/coresight/coresight-config.h > > @@ -164,4 +164,102 @@ struct cscfg_config_desc { > > const u64 *presets; /* nr_presets * nr_total_params */ > > }; > > > > +/** > > + * config register instance - part of a loaded feature. > > + * maps register values to csdev driver structures > > + * > > + * @value: value to use when setting feature on device / store for > > + * readback of volatile values. > > + * @drv_store: pointer to internal driver element used to set the value > > + * in hardware. > > + */ > > +struct cscfg_reg_csdev { > > Please rename this cscfg_regval_csdev to highlight the 1:1 mapping with > cscfg_regval_desc. Or rename cscfg_regval_desc to cscfg_reg_desc. I have no > opinion on which one it should be, as long as they are consistent. Doing so > really helps getting over the naming convention so that we can focus on the core > of the feature. > Will do. > > + struct cscfg_regval_desc value; > > + void *drv_store; > > +}; > > + > > +/** > > + * config parameter instance - part of a loaded feature. > > + * > > + * @feat: parent feature > > + * @reg: register value updated by this parameter. > > + * @current_value: current value of parameter - may be set by user via > > + * sysfs, or modified during device operation. > > + * @val64: true if 64 bit value > > + */ > > +struct cscfg_parameter_csdev { > > + struct cscfg_feature_csdev *feat; > > + struct cscfg_reg_csdev *reg; > > + u64 current_value; > > + bool val64; > > +}; > > + > > +/** > > + * Feature instance loaded into a CoreSight device. > > + * > > + * When a feature is loaded into a specific device, then this structure holds > > + * the connections between the register / parameter values used and the > > + * internal data structures that are written when the feature is enabled. > > + * > > + * Since applying a feature modifies internal data structures in the device, > > + * then we have a reference to the device spinlock to protect access to these > > + * structures (@csdev_spinlock). > > + * > > + * @desc: pointer to the static descriptor for this feature. > > + * @csdev: parent CoreSight device instance. > > + * @node: list entry into feature list for this device. > > + * @csdev_spinlock: device spinlock from csdev instance.. > > + * @nr_params: number of parameters. > > + * @params: current parameter values on this device > > + * @nr_regs: number of registers to be programmed. > > + * @regs: Programming details for the registers > > + */ > > +struct cscfg_feature_csdev { > > + const struct cscfg_feature_desc *desc; > > + struct coresight_device *csdev; > > + struct list_head node; > > + spinlock_t *csdev_spinlock; > > + int nr_params; > > + struct cscfg_parameter_csdev *params; > > + int nr_regs; > > + struct cscfg_reg_csdev *regs; > > +}; > > + > > +/** > > + * Configuration instance when loaded into a CoreSight device. > > + * > > + * The instance contains references to loaded features on this device that are > > + * used by the configuration. > > + * > > + * @desc: reference to the descriptor for this configuration > > + * @csdev: parent coresight device for this configuration instance. > > + * @node: list entry within the coresight device > > + * @nr_feat: Number of features on this device that are used in the > > + * configuration. > > + * @feats: reference to the device features to enable. > > + * @enabled: true if configuration is enabled on this device. > > + */ > > +struct cscfg_config_csdev { > > + const struct cscfg_config_desc *desc; > > + struct coresight_device *csdev; > > + struct list_head node; > > + int nr_feat; > > + struct cscfg_feature_csdev **feats; > > + bool enabled; > > +}; > > + > > +/** > > + * Coresight device operations. > > + * > > + * Registered coresight devices provide these operations to manage feature > > + * instances compatible with the device hardware and drivers > > + * > > + * @load_feat: Pass a feature descriptor into the device and create the > > + * loaded feature instance (struct cscfg_feature_csdev). > > + */ > > +struct cscfg_csdev_feat_ops { > > + int (*load_feat)(struct coresight_device *csdev, > > + struct cscfg_feature_csdev *feat); > > +}; > > + > > #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ > > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c > > index f7e396a5f9cb..c04cea0c1db2 100644 > > --- a/drivers/hwtracing/coresight/coresight-syscfg.c > > +++ b/drivers/hwtracing/coresight/coresight-syscfg.c > > @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; > > > > /* load features and configuations into the lists */ > > > > +/* protect the cfg lists in the csdev instances */ > > +static DEFINE_MUTEX(cscfg_csdev_mutex); > > + > > +/* get name feature instance from a coresight device list of features */ > > +static struct cscfg_feature_csdev * > > +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) > > +{ > > + struct cscfg_feature_csdev *feat = NULL; > > + > > + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { > > + if (strcmp(feat->desc->name, name) == 0) > > + return feat; > > + } > > + return NULL; > > +} > > + > > +/* allocate the device config instance - with max number of used features */ > > +static struct cscfg_config_csdev * > > +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) > > +{ > > + struct cscfg_config_csdev *dev_cfg = NULL; > > + struct device *dev = csdev->dev.parent; > > + > > + /* this is being allocated using the devm for the coresight device */ > > + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); > > + if (!dev_cfg) > > + return NULL; > > + > > + dev_cfg->csdev = csdev; > > + dev_cfg->feats = devm_kcalloc(dev, nr_feats, > > + sizeof(struct cscfg_feature_csdev *), > > + GFP_KERNEL); > > + if (!dev_cfg->feats) > > + dev_cfg = NULL; > > + return dev_cfg; > > +} > > + > > +/* check match info between used feature from the config and a regisered device */ > > +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, > > + struct cscfg_match_desc *reg_dev) > > +{ > > + /* if flags don't match then fail early */ > > + if (!(used_cmp->match_flags & reg_dev->match_flags)) > > + return false; > > + > > + return true; > > +} > > + > > +/* Load a config into a device if there are feature matches between config and device */ > > +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, > > + struct cscfg_match_desc *match_info, > > + struct cscfg_config_desc *cfg_desc) > > struct cscfg_config_desc *config_desc) > OK > > +{ > > + struct cscfg_config_csdev *dev_cfg = NULL; > > struct cscfg_config_csdev *config_csdev = NULL; > > > + struct cscfg_config_feat_ref *feat_ref; > > + struct cscfg_feature_csdev *feat; > > struct cscfg_feature_csdev *feat_csdev; OK > Please appy this kind of naming convention throughout the patchset. > Agreed - I'll update the nameing convention in the next set. Thanks Mike > > > + int checked; > > + > > + /* look at each required feature and see if it matches any feature on the device */ > > + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { > > + feat_ref = &cfg_desc->refs[checked]; > > + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { > > + /* device matched - get the feature */ > > + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); > > + if (!feat) > > + return -EINVAL; > > + if (!dev_cfg) { > > + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); > > + if (!dev_cfg) > > + return -ENOMEM; > > + dev_cfg->desc = cfg_desc; > > + } > > + dev_cfg->feats[dev_cfg->nr_feat++] = feat; > > + } > > + } > > + /* if matched features, add config to device.*/ > > + if (dev_cfg) { > > + mutex_lock(&cscfg_csdev_mutex); > > + list_add(&dev_cfg->node, &csdev->config_csdev_list); > > + mutex_unlock(&cscfg_csdev_mutex); > > + } > > + > > + return 0; > > +} > > + > > +/* > > + * Add the config to the set of registered devices - call with mutex locked. > > + * Iterates through devices - any device that matches one or more of the > > + * configuration features will load it, the others will ignore it. > > + */ > > +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) > > +{ > > + struct cscfg_csdev_register *curr_item; > > + int err; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > > + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); > > + if (err) > > + return err; > > + } > > + return 0; > > +} > > + > > +/* > > + * Allocate a feature object for load into a csdev. > > + * memory allocated using the csdev->dev object using devm managed allocator. > > + */ > > +static struct cscfg_feature_csdev * > > +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) > > +{ > > + struct cscfg_feature_csdev *feat = NULL; > > struct cscfg_feature_csdev *feat_csdev = NULL; > > > + struct device *dev = csdev->dev.parent; > > + int i; > > + > > + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); > > + if (!feat) > > + return NULL; > > + > > + /* parameters are optional - could be 0 */ > > + feat->nr_params = feat_desc->nr_params; > > + > > + /* > > + * if we need parameters, zero alloc the space here, the load routine in > > + * the csdev device driver will fill out some information according to > > + * feature descriptor. > > + */ > > + if (feat->nr_params) { > > + feat->params = devm_kcalloc(dev, feat->nr_params, > > + sizeof(struct cscfg_parameter_csdev), > > + GFP_KERNEL); > > + if (!feat->params) > > + return NULL; > > + > > + /* > > + * fill in the feature reference in the param - other fields > > + * handled by loader in csdev. > > + */ > > + for (i = 0; i < feat->nr_params; i++) > > + feat->params[i].feat = feat; > > + } > > + > > + /* > > + * Always have registers to program - again the load routine in csdev device > > + * will fill out according to feature descriptor and device requirements. > > + */ > > + feat->nr_regs = feat_desc->nr_regs; > > + feat->regs = devm_kcalloc(dev, feat->nr_regs, > > + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); > > + if (!feat->regs) > > + return NULL; > > + > > + /* load the feature default values */ > > + feat->desc = feat_desc; > > + feat->csdev = csdev; > > + > > + return feat; > > +} > > + > > +/* load one feature into one coresight device */ > > +static int cscfg_load_feat_csdev(struct coresight_device *csdev, > > + struct cscfg_feature_desc *feat_desc, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_feature_csdev *feat_csdev; > > + int err; > > + > > + if (!ops->load_feat) > > + return -EINVAL; > > + > > + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); > > + if (!feat_csdev) > > + return -ENOMEM; > > + > > + /* load the feature into the device - may modify default ops*/ > > + err = ops->load_feat(csdev, feat_csdev); > > + if (err) > > + return err; > > + > > + /* add to internal csdev feature list */ > > + mutex_lock(&cscfg_csdev_mutex); > > + list_add(&feat_csdev->node, &csdev->feature_csdev_list); > > + mutex_unlock(&cscfg_csdev_mutex); > > + > > + return 0; > > +} > > + > > +/* > > + * Add feature to any matching devices - call with mutex locked. > > + * Iterates through devices - any device that matches the feature will be > > + * called to load it. > > + */ > > +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) > > +{ > > + struct cscfg_csdev_register *curr_item; > > + int err; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->match_info.match_flags & feat_desc->match_flags) { > > + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); > > + if (err) > > + return err; > > + } > > + } > > + return 0; > > +} > > + > > /* check feature list for a named feature - call with mutex locked. */ > > static bool cscfg_match_list_feat(const char *name) > > { > > @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) > > */ > > static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) > > { > > + int err; > > + > > + /* add feature to any matching registered devices */ > > + err = cscfg_add_feat_to_csdevs(feat_desc); > > + if (err) > > + return err; > > + > > list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); > > > > return 0; > > @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) > > if (err) > > return err; > > > > + /* add config to any matching registered device */ > > + err = cscfg_add_cfg_to_csdevs(cfg_desc); > > + if (err) > > + return err; > > + > > list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); > > > > return 0; > > @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > > } > > EXPORT_SYMBOL_GPL(cscfg_load_config_sets); > > > > +/* Handle coresight device registration and add configs and features to devices */ > > + > > +/* iterate through config lists and load matching configs to device */ > > +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info) > > +{ > > + struct cscfg_config_desc *curr_item; > > + int err = 0; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { > > + err = cscfg_add_csdev_cfg(csdev, info, curr_item); > > + if (err) > > + break; > > + } > > + return err; > > +} > > + > > +/* iterate through feature lists and load matching features to device */ > > +static int cscfg_add_feats_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_feature_desc *curr_item; > > + int err = 0; > > + > > + if (!ops->load_feat) > > + return -EINVAL; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { > > + if (curr_item->match_flags & info->match_flags) { > > + err = cscfg_load_feat_csdev(csdev, curr_item, ops); > > + if (err) > > + break; > > + } > > + } > > + return err; > > +} > > + > > +/* Add coresight device to list and copy its matching info */ > > +static int cscfg_list_add_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_csdev_register *list_entry; > > + > > + /* allocate the list entry structure */ > > + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); > > + if (!list_entry) > > + return -ENOMEM; > > + > > + list_entry->csdev = csdev; > > + list_entry->match_info.match_flags = info->match_flags; > > + list_entry->ops.load_feat = ops->load_feat; > > + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); > > + > > + INIT_LIST_HEAD(&csdev->feature_csdev_list); > > + INIT_LIST_HEAD(&csdev->config_csdev_list); > > + cscfg_mgr->data.nr_csdev++; > > + > > + return 0; > > +} > > + > > +/* remove a coresight device from the list and free data */ > > +static void cscfg_list_remove_csdev(struct coresight_device *csdev) > > +{ > > + struct cscfg_csdev_register *curr_item, *tmp; > > + > > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->csdev == csdev) { > > + list_del(&curr_item->item); > > + kfree(curr_item); > > + cscfg_mgr->data.nr_csdev--; > > + break; > > + } > > + } > > +} > > + > > +/* register a coresight device with the syscfg api */ > > +int cscfg_register_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + int ret = 0; > > + > > + mutex_lock(&cscfg_mutex); > > + > > + /* add device to list of registered devices */ > > + ret = cscfg_list_add_csdev(csdev, info, ops); > > + if (ret) > > + goto reg_csdev_unlock; > > + > > + /* now load any registered features and configs matching the device. */ > > + ret = cscfg_add_feats_csdev(csdev, info, ops); > > + if (ret) { > > + cscfg_list_remove_csdev(csdev); > > + goto reg_csdev_unlock; > > + } > > + > > + ret = cscfg_add_cfgs_csdev(csdev, info); > > + if (ret) { > > + cscfg_list_remove_csdev(csdev); > > + goto reg_csdev_unlock; > > + } > > + > > + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); > > + > > +reg_csdev_unlock: > > + mutex_unlock(&cscfg_mutex); > > + return ret; > > +} > > +EXPORT_SYMBOL_GPL(cscfg_register_csdev); > > + > > +/* remove coresight device and update counts - syscfg device at 0 */ > > +void cscfg_unregister_csdev(struct coresight_device *csdev) > > +{ > > + struct cscfg_csdev_register *curr_item, *tmp; > > + > > + mutex_lock(&cscfg_mutex); > > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->csdev == csdev) { > > + list_del(&curr_item->item); > > + kfree(curr_item); > > + cscfg_mgr->data.nr_csdev--; > > + break; > > + } > > + } > > + mutex_unlock(&cscfg_mutex); > > +} > > +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); > > + > > /* Initialise system configuration management device. */ > > > > struct device *to_device_cscfg(void) > > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h > > index 907ba8d3efea..ebf5e1491d86 100644 > > --- a/drivers/hwtracing/coresight/coresight-syscfg.h > > +++ b/drivers/hwtracing/coresight/coresight-syscfg.h > > @@ -26,6 +26,22 @@ struct cscfg_api_data { > > int nr_csdev; > > }; > > > > +/** > > + * List entry for Coresight devices that are registered as supporting complex > > + * config operations. > > + * > > + * @csdev: The registered device. > > + * @match_info: The matching type information. > > + * @ops: Operations supported by the registered device. > > + * @item: list entry. > > + */ > > +struct cscfg_csdev_register { > > + struct coresight_device *csdev; > > + struct cscfg_match_desc match_info; > > + struct cscfg_csdev_feat_ops ops; > > + struct list_head item; > > +}; > > + > > /* internal core operations for cscfg */ > > int __init cscfg_init(void); > > void __exit cscfg_exit(void); > > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > > /* syscfg manager external API */ > > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > > struct cscfg_feature_desc **feat_descs); > > +int cscfg_register_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops); > > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > > > /** > > * System configuration manager device. > > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > > index 976ec2697610..d0126ed326a6 100644 > > --- a/include/linux/coresight.h > > +++ b/include/linux/coresight.h > > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > > * @nr_links: number of sysfs links created to other components from this > > * device. These will appear in the "connections" group. > > * @has_conns_grp: Have added a "connections" group for sysfs links. > > + * @feature_csdev_list: List of complex feature programming added to the device. > > + * @config_csdev_list: List of system configurations added to the device. > > */ > > struct coresight_device { > > struct coresight_platform_data *pdata; > > @@ -240,6 +242,9 @@ struct coresight_device { > > int nr_links; > > bool has_conns_grp; > > bool ect_enabled; /* true only if associated ect device is enabled */ > > + /* system configuration and feature lists */ > > + struct list_head feature_csdev_list; > > + struct list_head config_csdev_list; > > }; > > > > /* > > -- > > 2.17.1 > >
On Fri, Feb 26, 2021 at 07:14:32PM +0000, Mike Leach wrote: > Hi Mathieu, > > On Fri, 19 Feb 2021 at 18:43, Mathieu Poirier > <mathieu.poirier@linaro.org> wrote: > > > > [...] > > > > > +/** > > > + * List entry for Coresight devices that are registered as supporting complex > > > + * config operations. > > > + * > > > + * @csdev: The registered device. > > > + * @match_info: The matching type information. > > > + * @ops: Operations supported by the registered device. > > > + * @item: list entry. > > > + */ > > > +struct cscfg_csdev_register { > > > + struct coresight_device *csdev; > > > + struct cscfg_match_desc match_info; > > > + struct cscfg_csdev_feat_ops ops; > > > + struct list_head item; > > > +}; > > > > I would call this structure cscfg_registered_csdev and move it to > > coresight-config.h. That way it is consistent with cscfg_config_csdev and > > cscfg_feature_csdev and located all in the same file. > > > > I was trying to separate structures that are used to define > configurations and features, with those that are used to manage the > same. Hence, most things in coresight_config.h define configurations, > or their device loaded instance equivalents, and things in > coresight_syscfg.h are management items. I am happy to change the name > but would prefer is stay in coresight_syscfg.h Ok > > Thanks > > Mike >
Hi Mike There are some minor comments on the naming scheme of the structures, which I think might improve the code readability. e.g, in general anything that is associated with a csdev could be named as such csdev_*, rather than cscfg_*_csdev. The latter kind of implies "cscfg" is the "primary" object, while it is the csdev where we track this. Feel free to ignore. On 1/28/21 5:09 PM, Mike Leach wrote: > API for individual devices to register with the syscfg management > system is added. > > Devices register with matching information, and any features or > configurations that match will be loaded into the device. > > The feature and configuration loading is extended so that on load these > are loaded into any currently registered devices. This allows > configuration loading after devices have been registered. > > Signed-off-by: Mike Leach <mike.leach@linaro.org> > --- > .../hwtracing/coresight/coresight-config.h | 98 +++++ > .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ > .../hwtracing/coresight/coresight-syscfg.h | 20 + > include/linux/coresight.h | 5 + > 4 files changed, 471 insertions(+) > > diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h > index 3fedf8ab3cee..75ecdecf7013 100644 > --- a/drivers/hwtracing/coresight/coresight-config.h > +++ b/drivers/hwtracing/coresight/coresight-config.h > @@ -164,4 +164,102 @@ struct cscfg_config_desc { > const u64 *presets; /* nr_presets * nr_total_params */ > }; > > +/** > + * config register instance - part of a loaded feature. > + * maps register values to csdev driver structures > + * > + * @value: value to use when setting feature on device / store for > + * readback of volatile values. > + * @drv_store: pointer to internal driver element used to set the value > + * in hardware. > + */ > +struct cscfg_reg_csdev { minor nit: csdev_csfg_reg ? > + struct cscfg_regval_desc value; > + void *drv_store; > +}; I am not sure if it helps to move this drv_store field into csfg_regval_desc as "void *private". I haven't looked at the following patches. That way we have less number of structures to deal with. > + > +/** > + * config parameter instance - part of a loaded feature. > + * > + * @feat: parent feature > + * @reg: register value updated by this parameter. > + * @current_value: current value of parameter - may be set by user via > + * sysfs, or modified during device operation. > + * @val64: true if 64 bit value > + */ > +struct cscfg_parameter_csdev { nit: cscdev_cfg_parameter ? > + struct cscfg_feature_csdev *feat; nit: s/feat/cscfg_feat ? > + struct cscfg_reg_csdev *reg; nit: s/reg/cscfg_reg/ ? > + u64 current_value; > + bool val64; > +}; > + > +/** > + * Feature instance loaded into a CoreSight device. > + * > + * When a feature is loaded into a specific device, then this structure holds > + * the connections between the register / parameter values used and the > + * internal data structures that are written when the feature is enabled. > + * > + * Since applying a feature modifies internal data structures in the device, > + * then we have a reference to the device spinlock to protect access to these > + * structures (@csdev_spinlock). > + * > + * @desc: pointer to the static descriptor for this feature. > + * @csdev: parent CoreSight device instance. > + * @node: list entry into feature list for this device. > + * @csdev_spinlock: device spinlock from csdev instance.. > + * @nr_params: number of parameters. > + * @params: current parameter values on this device > + * @nr_regs: number of registers to be programmed. > + * @regs: Programming details for the registers > + */ > +struct cscfg_feature_csdev { > + const struct cscfg_feature_desc *desc; nit: s/desc/cscfg_feat_desc ? > + struct coresight_device *csdev; > + struct list_head node; > + spinlock_t *csdev_spinlock; Why do we need this explicitly here when we have access to csdev ? > + int nr_params; > + struct cscfg_parameter_csdev *params; nit: s/params/cscfg_params/ ? > + int nr_regs; > + struct cscfg_reg_csdev *regs; nit: cscfg_regs ? > +}; > + > +/** > + * Configuration instance when loaded into a CoreSight device. > + * > + * The instance contains references to loaded features on this device that are > + * used by the configuration. > + * > + * @desc: reference to the descriptor for this configuration > + * @csdev: parent coresight device for this configuration instance. > + * @node: list entry within the coresight device > + * @nr_feat: Number of features on this device that are used in the > + * configuration. > + * @feats: reference to the device features to enable. > + * @enabled: true if configuration is enabled on this device. > + */ > +struct cscfg_config_csdev { nit: csdev_cscfg_config ? > + const struct cscfg_config_desc *desc; > + struct coresight_device *csdev; > + struct list_head node; > + int nr_feat; > + struct cscfg_feature_csdev **feats; > + bool enabled; > +}; If you rearrange the fields a bit like below, you could optimize the allocations: struct cscfg_config_csdev { bool enabled; > + const struct cscfg_config_desc *desc; > + struct coresight_device *csdev; > + struct list_head node; int nr_feat; struct cscfg_feature_csdev *cscfg_feats[0] }; cscfg_config = devm_kzalloc(dev, offsetof(struct cscfg_config_csdev, cscfg_feats[nr_feat]), GFP_KERNEL); Instead of additional allocation for the array below. > + > +/** > + * Coresight device operations. > + * > + * Registered coresight devices provide these operations to manage feature > + * instances compatible with the device hardware and drivers > + * > + * @load_feat: Pass a feature descriptor into the device and create the > + * loaded feature instance (struct cscfg_feature_csdev). > + */ > +struct cscfg_csdev_feat_ops { > + int (*load_feat)(struct coresight_device *csdev, > + struct cscfg_feature_csdev *feat); > +}; > + > #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c > index f7e396a5f9cb..c04cea0c1db2 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.c > +++ b/drivers/hwtracing/coresight/coresight-syscfg.c > @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; > > /* load features and configuations into the lists */ > > +/* protect the cfg lists in the csdev instances */ > +static DEFINE_MUTEX(cscfg_csdev_mutex); > + > +/* get name feature instance from a coresight device list of features */ > +static struct cscfg_feature_csdev * > +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) > +{ > + struct cscfg_feature_csdev *feat = NULL; > + > + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { > + if (strcmp(feat->desc->name, name) == 0) > + return feat; > + } > + return NULL; > +} > + > +/* allocate the device config instance - with max number of used features */ > +static struct cscfg_config_csdev * > +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; > + struct device *dev = csdev->dev.parent; > + > + /* this is being allocated using the devm for the coresight device */ > + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); > + if (!dev_cfg) > + return NULL; Please see my comment above struct field re-organization and ease of allocation above. > + > + dev_cfg->csdev = csdev; > + dev_cfg->feats = devm_kcalloc(dev, nr_feats, > + sizeof(struct cscfg_feature_csdev *), > + GFP_KERNEL); > + if (!dev_cfg->feats) > + dev_cfg = NULL; > + return dev_cfg; > +} > + > +/* check match info between used feature from the config and a regisered device */ > +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, minor nit: s/used_cmp/feat_match ? > + struct cscfg_match_desc *reg_dev) s/reg_dev/ > +{ > + /* if flags don't match then fail early */ > + if (!(used_cmp->match_flags & reg_dev->match_flags)) > + return false; > + > + return true; > +} > + > +/* Load a config into a device if there are feature matches between config and device */ > +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, > + struct cscfg_match_desc *match_info, > + struct cscfg_config_desc *cfg_desc) Why not pass struct cscfg_csdev_register * instead of the first two parameters ? That way, it is easier to follow what we do here too. > +{ > + struct cscfg_config_csdev *dev_cfg = NULL; > + struct cscfg_config_feat_ref *feat_ref; > + struct cscfg_feature_csdev *feat; > + int checked; super minor nit: s/checked/i ? > + > + /* look at each required feature and see if it matches any feature on the device */ > + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { > + feat_ref = &cfg_desc->refs[checked]; > + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { > + /* device matched - get the feature */ > + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); > + if (!feat) > + return -EINVAL; > + if (!dev_cfg) { > + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); > + if (!dev_cfg) > + return -ENOMEM; > + dev_cfg->desc = cfg_desc; > + } > + dev_cfg->feats[dev_cfg->nr_feat++] = feat; > + } > + } I understand we don't have dynamic unloading of the features yet, but it would be good to do the above step with the mutex held to protect us when we add the unloading, to prevent a config deleted while we are adding it here. > + /* if matched features, add config to device.*/ > + if (dev_cfg) { > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&dev_cfg->node, &csdev->config_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + } > + > + return 0; > +} > + > +/* > + * Add the config to the set of registered devices - call with mutex locked. > + * Iterates through devices - any device that matches one or more of the > + * configuration features will load it, the others will ignore it. > + */ > +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) > +{ > + struct cscfg_csdev_register *curr_item; minor nit: s/curr_item/csdev_reg > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); Could we not make this err = cscfg_add_csdev_cfg(cscfg_csdev, cfg_desc); ? Which easily implies, load cfg_desc to a csdev. > + if (err) > + return err; > + } > + return 0; > +} > + > +/* > + * Allocate a feature object for load into a csdev. > + * memory allocated using the csdev->dev object using devm managed allocator. > + */ > +static struct cscfg_feature_csdev * > +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_feature_csdev *feat = NULL; > + struct device *dev = csdev->dev.parent; > + int i; > + > + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); > + if (!feat) > + return NULL; > + > + /* parameters are optional - could be 0 */ > + feat->nr_params = feat_desc->nr_params; > + > + /* > + * if we need parameters, zero alloc the space here, the load routine in > + * the csdev device driver will fill out some information according to > + * feature descriptor. > + */ > + if (feat->nr_params) { > + feat->params = devm_kcalloc(dev, feat->nr_params, > + sizeof(struct cscfg_parameter_csdev), > + GFP_KERNEL); > + if (!feat->params) > + return NULL; > + > + /* > + * fill in the feature reference in the param - other fields > + * handled by loader in csdev. > + */ > + for (i = 0; i < feat->nr_params; i++) > + feat->params[i].feat = feat; > + } > + > + /* > + * Always have registers to program - again the load routine in csdev device > + * will fill out according to feature descriptor and device requirements. > + */ > + feat->nr_regs = feat_desc->nr_regs; > + feat->regs = devm_kcalloc(dev, feat->nr_regs, > + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); > + if (!feat->regs) > + return NULL; > + > + /* load the feature default values */ > + feat->desc = feat_desc; > + feat->csdev = csdev; > + > + return feat; > +} > + > +/* load one feature into one coresight device */ > +static int cscfg_load_feat_csdev(struct coresight_device *csdev, > + struct cscfg_feature_desc *feat_desc, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_csdev *feat_csdev; > + int err; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); > + if (!feat_csdev) > + return -ENOMEM; > + > + /* load the feature into the device - may modify default ops*/ > + err = ops->load_feat(csdev, feat_csdev); > + if (err) > + return err; > + > + /* add to internal csdev feature list */ > + mutex_lock(&cscfg_csdev_mutex); > + list_add(&feat_csdev->node, &csdev->feature_csdev_list); > + mutex_unlock(&cscfg_csdev_mutex); > + > + return 0; > +} > + > +/* > + * Add feature to any matching devices - call with mutex locked. > + * Iterates through devices - any device that matches the feature will be > + * called to load it. > + */ > +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) > +{ > + struct cscfg_csdev_register *curr_item; > + int err; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->match_info.match_flags & feat_desc->match_flags) { > + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); > + if (err) > + return err; > + } > + } > + return 0; > +} > + > /* check feature list for a named feature - call with mutex locked. */ > static bool cscfg_match_list_feat(const char *name) > { > @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) > */ > static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) > { > + int err; > + > + /* add feature to any matching registered devices */ > + err = cscfg_add_feat_to_csdevs(feat_desc); > + if (err) > + return err; > + > list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); > > return 0; > @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) > if (err) > return err; > > + /* add config to any matching registered device */ > + err = cscfg_add_cfg_to_csdevs(cfg_desc); > + if (err) > + return err; > + > list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); > > return 0; > @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > } > EXPORT_SYMBOL_GPL(cscfg_load_config_sets); > > +/* Handle coresight device registration and add configs and features to devices */ > + > +/* iterate through config lists and load matching configs to device */ > +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info) > +{ > + struct cscfg_config_desc *curr_item; > + int err = 0; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { > + err = cscfg_add_csdev_cfg(csdev, info, curr_item); > + if (err) > + break; > + } > + return err; > +} > + > +/* iterate through feature lists and load matching features to device */ > +static int cscfg_add_feats_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_feature_desc *curr_item; > + int err = 0; > + > + if (!ops->load_feat) > + return -EINVAL; > + > + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { > + if (curr_item->match_flags & info->match_flags) { > + err = cscfg_load_feat_csdev(csdev, curr_item, ops); > + if (err) > + break; > + } > + } > + return err; > +} > + > +/* Add coresight device to list and copy its matching info */ > +static int cscfg_list_add_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + struct cscfg_csdev_register *list_entry; > + > + /* allocate the list entry structure */ > + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); > + if (!list_entry) > + return -ENOMEM; > + > + list_entry->csdev = csdev; > + list_entry->match_info.match_flags = info->match_flags; > + list_entry->ops.load_feat = ops->load_feat; > + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); > + > + INIT_LIST_HEAD(&csdev->feature_csdev_list); > + INIT_LIST_HEAD(&csdev->config_csdev_list); > + cscfg_mgr->data.nr_csdev++; > + > + return 0; > +} > + > +/* remove a coresight device from the list and free data */ > +static void cscfg_list_remove_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; > + > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > +} > + > +/* register a coresight device with the syscfg api */ > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops) > +{ > + int ret = 0; > + > + mutex_lock(&cscfg_mutex); > + > + /* add device to list of registered devices */ > + ret = cscfg_list_add_csdev(csdev, info, ops); > + if (ret) > + goto reg_csdev_unlock; > + > + /* now load any registered features and configs matching the device. */ > + ret = cscfg_add_feats_csdev(csdev, info, ops); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + ret = cscfg_add_cfgs_csdev(csdev, info); > + if (ret) { > + cscfg_list_remove_csdev(csdev); > + goto reg_csdev_unlock; > + } > + > + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); > + > +reg_csdev_unlock: > + mutex_unlock(&cscfg_mutex); > + return ret; > +} > +EXPORT_SYMBOL_GPL(cscfg_register_csdev); > + > +/* remove coresight device and update counts - syscfg device at 0 */ > +void cscfg_unregister_csdev(struct coresight_device *csdev) > +{ > + struct cscfg_csdev_register *curr_item, *tmp; s/curr_item/cscfg_csdev/ or something similar. Using generic names makes the field dereferencing bit suspicious. > + > + mutex_lock(&cscfg_mutex); > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > + if (curr_item->csdev == csdev) { > + list_del(&curr_item->item); > + kfree(curr_item); > + cscfg_mgr->data.nr_csdev--; > + break; > + } > + } > + mutex_unlock(&cscfg_mutex); > +} > +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); > + > /* Initialise system configuration management device. */ > > struct device *to_device_cscfg(void) > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h > index 907ba8d3efea..ebf5e1491d86 100644 > --- a/drivers/hwtracing/coresight/coresight-syscfg.h > +++ b/drivers/hwtracing/coresight/coresight-syscfg.h > @@ -26,6 +26,22 @@ struct cscfg_api_data { > int nr_csdev; > }; > > +/** > + * List entry for Coresight devices that are registered as supporting complex > + * config operations. > + * > + * @csdev: The registered device. > + * @match_info: The matching type information. > + * @ops: Operations supported by the registered device. > + * @item: list entry. > + */ > +struct cscfg_csdev_register { > + struct coresight_device *csdev; > + struct cscfg_match_desc match_info; > + struct cscfg_csdev_feat_ops ops; > + struct list_head item; > +}; If a device is only registered once : Could we inline this struct into the coresight_device removing the csdev ? We should be able to use container_of() to get to the coresight_device from the "item" and then get to the match_info and feat_ops. That might simplify the code a little bit, in terms of the number of different structures that we keep track of and makes it easier to follow the code. > + > /* internal core operations for cscfg */ > int __init cscfg_init(void); > void __exit cscfg_exit(void); > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > /* syscfg manager external API */ > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > struct cscfg_feature_desc **feat_descs); > +int cscfg_register_csdev(struct coresight_device *csdev, > + struct cscfg_match_desc *info, > + struct cscfg_csdev_feat_ops *ops); Yet to see how this will be invoked, but I feel like the csdev might be all you need here. I will look at the following patches. > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > /** > * System configuration manager device. > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > index 976ec2697610..d0126ed326a6 100644 > --- a/include/linux/coresight.h > +++ b/include/linux/coresight.h > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > * @nr_links: number of sysfs links created to other components from this > * device. These will appear in the "connections" group. > * @has_conns_grp: Have added a "connections" group for sysfs links. > + * @feature_csdev_list: List of complex feature programming added to the device. > + * @config_csdev_list: List of system configurations added to the device. > */ > struct coresight_device { > struct coresight_platform_data *pdata; > @@ -240,6 +242,9 @@ struct coresight_device { > int nr_links; > bool has_conns_grp; > bool ect_enabled; /* true only if associated ect device is enabled */ > + /* system configuration and feature lists */ > + struct list_head feature_csdev_list; > + struct list_head config_csdev_list; > }; > > /* >
Hi Suzuki On Thu, 4 Mar 2021 at 10:33, Suzuki K Poulose <suzuki.poulose@arm.com> wrote: > > Hi Mike > > There are some minor comments on the naming scheme of the structures, > which I think might improve the code readability. > > e.g, in general anything that is associated with a csdev could be named > as such csdev_*, rather than cscfg_*_csdev. The latter kind of implies > "cscfg" is the "primary" object, while it is the csdev where we track > this. > > Feel free to ignore. > > On 1/28/21 5:09 PM, Mike Leach wrote: > > API for individual devices to register with the syscfg management > > system is added. > > > > Devices register with matching information, and any features or > > configurations that match will be loaded into the device. > > > > The feature and configuration loading is extended so that on load these > > are loaded into any currently registered devices. This allows > > configuration loading after devices have been registered. > > > > Signed-off-by: Mike Leach <mike.leach@linaro.org> > > --- > > .../hwtracing/coresight/coresight-config.h | 98 +++++ > > .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ > > .../hwtracing/coresight/coresight-syscfg.h | 20 + > > include/linux/coresight.h | 5 + > > 4 files changed, 471 insertions(+) > > > > diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h > > index 3fedf8ab3cee..75ecdecf7013 100644 > > --- a/drivers/hwtracing/coresight/coresight-config.h > > +++ b/drivers/hwtracing/coresight/coresight-config.h > > @@ -164,4 +164,102 @@ struct cscfg_config_desc { > > const u64 *presets; /* nr_presets * nr_total_params */ > > }; > > > > +/** > > + * config register instance - part of a loaded feature. > > + * maps register values to csdev driver structures > > + * > > + * @value: value to use when setting feature on device / store for > > + * readback of volatile values. > > + * @drv_store: pointer to internal driver element used to set the value > > + * in hardware. > > + */ > > +struct cscfg_reg_csdev { > > minor nit: csdev_csfg_reg ? > > > + struct cscfg_regval_desc value; > > + void *drv_store; > > +}; > > I am not sure if it helps to move this drv_store field into csfg_regval_desc > as "void *private". I haven't looked at the following patches. That way we > have less number of structures to deal with. > drv_store is a per csdev instance value accessing per device data - so cannot be part of the single registerregval_desc descriptor in the feature desc. > > + > > +/** > > + * config parameter instance - part of a loaded feature. > > + * > > + * @feat: parent feature > > + * @reg: register value updated by this parameter. > > + * @current_value: current value of parameter - may be set by user via > > + * sysfs, or modified during device operation. > > + * @val64: true if 64 bit value > > + */ > > +struct cscfg_parameter_csdev { > > nit: cscdev_cfg_parameter ? > > > + struct cscfg_feature_csdev *feat; > > nit: s/feat/cscfg_feat ? > > > + struct cscfg_reg_csdev *reg; > > nit: s/reg/cscfg_reg/ ? > > > + u64 current_value; > > + bool val64; > > +}; > > + > > +/** > > + * Feature instance loaded into a CoreSight device. > > + * > > + * When a feature is loaded into a specific device, then this structure holds > > + * the connections between the register / parameter values used and the > > + * internal data structures that are written when the feature is enabled. > > + * > > + * Since applying a feature modifies internal data structures in the device, > > + * then we have a reference to the device spinlock to protect access to these > > + * structures (@csdev_spinlock). > > + * > > + * @desc: pointer to the static descriptor for this feature. > > + * @csdev: parent CoreSight device instance. > > + * @node: list entry into feature list for this device. > > + * @csdev_spinlock: device spinlock from csdev instance.. > > + * @nr_params: number of parameters. > > + * @params: current parameter values on this device > > + * @nr_regs: number of registers to be programmed. > > + * @regs: Programming details for the registers > > + */ > > +struct cscfg_feature_csdev { > > + const struct cscfg_feature_desc *desc; > > nit: s/desc/cscfg_feat_desc ? > > > + struct coresight_device *csdev; > > + struct list_head node; > > + spinlock_t *csdev_spinlock; > > Why do we need this explicitly here when we have access to csdev ? > > > + int nr_params; > > + struct cscfg_parameter_csdev *params; > > nit: s/params/cscfg_params/ ? > > > + int nr_regs; > > + struct cscfg_reg_csdev *regs; > > nit: cscfg_regs ? > > > +}; > > + > > +/** > > + * Configuration instance when loaded into a CoreSight device. > > + * > > + * The instance contains references to loaded features on this device that are > > + * used by the configuration. > > + * > > + * @desc: reference to the descriptor for this configuration > > + * @csdev: parent coresight device for this configuration instance. > > + * @node: list entry within the coresight device > > + * @nr_feat: Number of features on this device that are used in the > > + * configuration. > > + * @feats: reference to the device features to enable. > > + * @enabled: true if configuration is enabled on this device. > > + */ > > +struct cscfg_config_csdev { > > nit: csdev_cscfg_config ? > > > + const struct cscfg_config_desc *desc; > > + struct coresight_device *csdev; > > + struct list_head node; > > + int nr_feat; > > + struct cscfg_feature_csdev **feats; > > + bool enabled; > > +}; > > If you rearrange the fields a bit like below, you could optimize the > allocations: > > struct cscfg_config_csdev { > bool enabled; > > + const struct cscfg_config_desc *desc; > > + struct coresight_device *csdev; > > + struct list_head node; > int nr_feat; > struct cscfg_feature_csdev *cscfg_feats[0] > }; > > cscfg_config = devm_kzalloc(dev, > offsetof(struct cscfg_config_csdev, cscfg_feats[nr_feat]), > GFP_KERNEL); > > Instead of additional allocation for the array below. > OK. > > + > > +/** > > + * Coresight device operations. > > + * > > + * Registered coresight devices provide these operations to manage feature > > + * instances compatible with the device hardware and drivers > > + * > > + * @load_feat: Pass a feature descriptor into the device and create the > > + * loaded feature instance (struct cscfg_feature_csdev). > > + */ > > +struct cscfg_csdev_feat_ops { > > + int (*load_feat)(struct coresight_device *csdev, > > + struct cscfg_feature_csdev *feat); > > +}; > > + > > #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ > > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c > > index f7e396a5f9cb..c04cea0c1db2 100644 > > --- a/drivers/hwtracing/coresight/coresight-syscfg.c > > +++ b/drivers/hwtracing/coresight/coresight-syscfg.c > > @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; > > > > /* load features and configuations into the lists */ > > > > +/* protect the cfg lists in the csdev instances */ > > +static DEFINE_MUTEX(cscfg_csdev_mutex); > > + > > +/* get name feature instance from a coresight device list of features */ > > +static struct cscfg_feature_csdev * > > +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) > > +{ > > + struct cscfg_feature_csdev *feat = NULL; > > + > > + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { > > + if (strcmp(feat->desc->name, name) == 0) > > + return feat; > > + } > > + return NULL; > > +} > > + > > +/* allocate the device config instance - with max number of used features */ > > +static struct cscfg_config_csdev * > > +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) > > +{ > > + struct cscfg_config_csdev *dev_cfg = NULL; > > + struct device *dev = csdev->dev.parent; > > + > > + /* this is being allocated using the devm for the coresight device */ > > + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); > > + if (!dev_cfg) > > + return NULL; > > Please see my comment above struct field re-organization and ease of allocation above. > > + > > + dev_cfg->csdev = csdev; > > + dev_cfg->feats = devm_kcalloc(dev, nr_feats, > > + sizeof(struct cscfg_feature_csdev *), > > + GFP_KERNEL); > > + if (!dev_cfg->feats) > > + dev_cfg = NULL; > > + return dev_cfg; > > +} > > + > > +/* check match info between used feature from the config and a regisered device */ > > +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, > > minor nit: s/used_cmp/feat_match ? > > > + struct cscfg_match_desc *reg_dev) > > s/reg_dev/ > > +{ > > + /* if flags don't match then fail early */ > > + if (!(used_cmp->match_flags & reg_dev->match_flags)) > > + return false; > > + > > + return true; > > +} > > + > > +/* Load a config into a device if there are feature matches between config and device */ > > +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, > > + struct cscfg_match_desc *match_info, > > + struct cscfg_config_desc *cfg_desc) > > Why not pass struct cscfg_csdev_register * instead of the first two parameters ? > That way, it is easier to follow what we do here too. > > > +{ > > + struct cscfg_config_csdev *dev_cfg = NULL; > > + struct cscfg_config_feat_ref *feat_ref; > > + struct cscfg_feature_csdev *feat; > > + int checked; > > super minor nit: s/checked/i ? > > > + > > + /* look at each required feature and see if it matches any feature on the device */ > > + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { > > + feat_ref = &cfg_desc->refs[checked]; > > + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { > > + /* device matched - get the feature */ > > + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); > > + if (!feat) > > + return -EINVAL; > > + if (!dev_cfg) { > > + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); > > + if (!dev_cfg) > > + return -ENOMEM; > > + dev_cfg->desc = cfg_desc; > > + } > > + dev_cfg->feats[dev_cfg->nr_feat++] = feat; > > + } > > + } > > I understand we don't have dynamic unloading of the features yet, but it would > be good to do the above step with the mutex held to protect us when we add the > unloading, to prevent a config deleted while we are adding it here. > The cscfg_csdev_mutex protects the csdev loaded config instance lists, in order to prevent another config / feature being added while the csdev is being enabled / disabled and enabling or disabling a config. It will not be possible to remove a config at the same time as we are adding one, as the dyn loading will preclude adding and removing at the same time using the cscfg_mutex, which protects the descriptor lists in the cscfg_manager. Adding configs will be permitted while other configs are active, removing them will only ever occur when nothing is active (otherwise there is a world of dependency related pain). > > + /* if matched features, add config to device.*/ > > + if (dev_cfg) { > > + mutex_lock(&cscfg_csdev_mutex); > > + list_add(&dev_cfg->node, &csdev->config_csdev_list); > > + mutex_unlock(&cscfg_csdev_mutex); > > + } > > + > > + return 0; > > +} > > + > > +/* > > + * Add the config to the set of registered devices - call with mutex locked. > > + * Iterates through devices - any device that matches one or more of the > > + * configuration features will load it, the others will ignore it. > > + */ > > +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) > > +{ > > + struct cscfg_csdev_register *curr_item; > > minor nit: s/curr_item/csdev_reg > OK. > > + int err; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > > + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); > > Could we not make this > > err = cscfg_add_csdev_cfg(cscfg_csdev, cfg_desc); ? > > Which easily implies, load cfg_desc to a csdev. > > This has been re-written / simplified > > > + if (err) > > + return err; > > + } > > + return 0; > > +} > > + > > +/* > > + * Allocate a feature object for load into a csdev. > > + * memory allocated using the csdev->dev object using devm managed allocator. > > + */ > > +static struct cscfg_feature_csdev * > > +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) > > +{ > > + struct cscfg_feature_csdev *feat = NULL; > > + struct device *dev = csdev->dev.parent; > > + int i; > > + > > + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); > > + if (!feat) > > + return NULL; > > + > > + /* parameters are optional - could be 0 */ > > + feat->nr_params = feat_desc->nr_params; > > + > > + /* > > + * if we need parameters, zero alloc the space here, the load routine in > > + * the csdev device driver will fill out some information according to > > + * feature descriptor. > > + */ > > + if (feat->nr_params) { > > + feat->params = devm_kcalloc(dev, feat->nr_params, > > + sizeof(struct cscfg_parameter_csdev), > > + GFP_KERNEL); > > + if (!feat->params) > > + return NULL; > > + > > + /* > > + * fill in the feature reference in the param - other fields > > + * handled by loader in csdev. > > + */ > > + for (i = 0; i < feat->nr_params; i++) > > + feat->params[i].feat = feat; > > + } > > + > > + /* > > + * Always have registers to program - again the load routine in csdev device > > + * will fill out according to feature descriptor and device requirements. > > + */ > > + feat->nr_regs = feat_desc->nr_regs; > > + feat->regs = devm_kcalloc(dev, feat->nr_regs, > > + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); > > + if (!feat->regs) > > + return NULL; > > + > > + /* load the feature default values */ > > + feat->desc = feat_desc; > > + feat->csdev = csdev; > > + > > + return feat; > > +} > > + > > +/* load one feature into one coresight device */ > > +static int cscfg_load_feat_csdev(struct coresight_device *csdev, > > + struct cscfg_feature_desc *feat_desc, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_feature_csdev *feat_csdev; > > + int err; > > + > > + if (!ops->load_feat) > > + return -EINVAL; > > + > > + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); > > + if (!feat_csdev) > > + return -ENOMEM; > > + > > + /* load the feature into the device - may modify default ops*/ > > + err = ops->load_feat(csdev, feat_csdev); > > + if (err) > > + return err; > > + > > + /* add to internal csdev feature list */ > > + mutex_lock(&cscfg_csdev_mutex); > > + list_add(&feat_csdev->node, &csdev->feature_csdev_list); > > + mutex_unlock(&cscfg_csdev_mutex); > > + > > + return 0; > > +} > > + > > +/* > > + * Add feature to any matching devices - call with mutex locked. > > + * Iterates through devices - any device that matches the feature will be > > + * called to load it. > > + */ > > +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) > > +{ > > + struct cscfg_csdev_register *curr_item; > > + int err; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->match_info.match_flags & feat_desc->match_flags) { > > + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); > > + if (err) > > + return err; > > + } > > + } > > + return 0; > > +} > > + > > /* check feature list for a named feature - call with mutex locked. */ > > static bool cscfg_match_list_feat(const char *name) > > { > > @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) > > */ > > static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) > > { > > + int err; > > + > > + /* add feature to any matching registered devices */ > > + err = cscfg_add_feat_to_csdevs(feat_desc); > > + if (err) > > + return err; > > + > > list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); > > > > return 0; > > @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) > > if (err) > > return err; > > > > + /* add config to any matching registered device */ > > + err = cscfg_add_cfg_to_csdevs(cfg_desc); > > + if (err) > > + return err; > > + > > list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); > > > > return 0; > > @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > > } > > EXPORT_SYMBOL_GPL(cscfg_load_config_sets); > > > > +/* Handle coresight device registration and add configs and features to devices */ > > + > > +/* iterate through config lists and load matching configs to device */ > > +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info) > > +{ > > + struct cscfg_config_desc *curr_item; > > + int err = 0; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { > > + err = cscfg_add_csdev_cfg(csdev, info, curr_item); > > + if (err) > > + break; > > + } > > + return err; > > +} > > + > > +/* iterate through feature lists and load matching features to device */ > > +static int cscfg_add_feats_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_feature_desc *curr_item; > > + int err = 0; > > + > > + if (!ops->load_feat) > > + return -EINVAL; > > + > > + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { > > + if (curr_item->match_flags & info->match_flags) { > > + err = cscfg_load_feat_csdev(csdev, curr_item, ops); > > + if (err) > > + break; > > + } > > + } > > + return err; > > +} > > + > > +/* Add coresight device to list and copy its matching info */ > > +static int cscfg_list_add_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + struct cscfg_csdev_register *list_entry; > > + > > + /* allocate the list entry structure */ > > + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); > > + if (!list_entry) > > + return -ENOMEM; > > + > > + list_entry->csdev = csdev; > > + list_entry->match_info.match_flags = info->match_flags; > > + list_entry->ops.load_feat = ops->load_feat; > > + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); > > + > > + INIT_LIST_HEAD(&csdev->feature_csdev_list); > > + INIT_LIST_HEAD(&csdev->config_csdev_list); > > + cscfg_mgr->data.nr_csdev++; > > + > > + return 0; > > +} > > + > > +/* remove a coresight device from the list and free data */ > > +static void cscfg_list_remove_csdev(struct coresight_device *csdev) > > +{ > > + struct cscfg_csdev_register *curr_item, *tmp; > > + > > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->csdev == csdev) { > > + list_del(&curr_item->item); > > + kfree(curr_item); > > + cscfg_mgr->data.nr_csdev--; > > + break; > > + } > > + } > > +} > > + > > +/* register a coresight device with the syscfg api */ > > +int cscfg_register_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops) > > +{ > > + int ret = 0; > > + > > + mutex_lock(&cscfg_mutex); > > + > > + /* add device to list of registered devices */ > > + ret = cscfg_list_add_csdev(csdev, info, ops); > > + if (ret) > > + goto reg_csdev_unlock; > > + > > + /* now load any registered features and configs matching the device. */ > > + ret = cscfg_add_feats_csdev(csdev, info, ops); > > + if (ret) { > > + cscfg_list_remove_csdev(csdev); > > + goto reg_csdev_unlock; > > + } > > + > > + ret = cscfg_add_cfgs_csdev(csdev, info); > > + if (ret) { > > + cscfg_list_remove_csdev(csdev); > > + goto reg_csdev_unlock; > > + } > > + > > + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); > > + > > +reg_csdev_unlock: > > + mutex_unlock(&cscfg_mutex); > > + return ret; > > +} > > +EXPORT_SYMBOL_GPL(cscfg_register_csdev); > > + > > +/* remove coresight device and update counts - syscfg device at 0 */ > > +void cscfg_unregister_csdev(struct coresight_device *csdev) > > +{ > > + struct cscfg_csdev_register *curr_item, *tmp; > > s/curr_item/cscfg_csdev/ or something similar. Using generic names > makes the field dereferencing bit suspicious. > > > + > > + mutex_lock(&cscfg_mutex); > > + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { > > + if (curr_item->csdev == csdev) { > > + list_del(&curr_item->item); > > + kfree(curr_item); > > + cscfg_mgr->data.nr_csdev--; > > + break; > > + } > > + } > > + mutex_unlock(&cscfg_mutex); > > +} > > +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); > > + > > /* Initialise system configuration management device. */ > > > > struct device *to_device_cscfg(void) > > diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h > > index 907ba8d3efea..ebf5e1491d86 100644 > > --- a/drivers/hwtracing/coresight/coresight-syscfg.h > > +++ b/drivers/hwtracing/coresight/coresight-syscfg.h > > @@ -26,6 +26,22 @@ struct cscfg_api_data { > > int nr_csdev; > > }; > > > > +/** > > + * List entry for Coresight devices that are registered as supporting complex > > + * config operations. > > + * > > + * @csdev: The registered device. > > + * @match_info: The matching type information. > > + * @ops: Operations supported by the registered device. > > + * @item: list entry. > > + */ > > +struct cscfg_csdev_register { > > + struct coresight_device *csdev; > > + struct cscfg_match_desc match_info; > > + struct cscfg_csdev_feat_ops ops; > > + struct list_head item; > > +}; > > If a device is only registered once : > > Could we inline this struct into the coresight_device removing > the csdev ? We should be able to use container_of() to get to the > coresight_device from the "item" and then get to the match_info > and feat_ops. > > That might simplify the code a little bit, in terms of the > number of different structures that we keep track of and > makes it easier to follow the code. > I think that just moves some extra fields we need to keep track of into a different structure. I like to keep the cscfg related stuff together where possible. > > > + > > /* internal core operations for cscfg */ > > int __init cscfg_init(void); > > void __exit cscfg_exit(void); > > @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); > > /* syscfg manager external API */ > > int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, > > struct cscfg_feature_desc **feat_descs); > > +int cscfg_register_csdev(struct coresight_device *csdev, > > + struct cscfg_match_desc *info, > > + struct cscfg_csdev_feat_ops *ops); > > Yet to see how this will be invoked, but I feel like the csdev > might be all you need here. I will look at the following patches. > > > +void cscfg_unregister_csdev(struct coresight_device *csdev); > > > > /** > > * System configuration manager device. > > diff --git a/include/linux/coresight.h b/include/linux/coresight.h > > index 976ec2697610..d0126ed326a6 100644 > > --- a/include/linux/coresight.h > > +++ b/include/linux/coresight.h > > @@ -219,6 +219,8 @@ struct coresight_sysfs_link { > > * @nr_links: number of sysfs links created to other components from this > > * device. These will appear in the "connections" group. > > * @has_conns_grp: Have added a "connections" group for sysfs links. > > + * @feature_csdev_list: List of complex feature programming added to the device. > > + * @config_csdev_list: List of system configurations added to the device. > > */ > > struct coresight_device { > > struct coresight_platform_data *pdata; > > @@ -240,6 +242,9 @@ struct coresight_device { > > int nr_links; > > bool has_conns_grp; > > bool ect_enabled; /* true only if associated ect device is enabled */ > > + /* system configuration and feature lists */ > > + struct list_head feature_csdev_list; > > + struct list_head config_csdev_list; > > }; > > > > > /* > > > Thnaks and regards Mike -- Mike Leach Principal Engineer, ARM Ltd. Manchester Design Centre. UK
diff --git a/drivers/hwtracing/coresight/coresight-config.h b/drivers/hwtracing/coresight/coresight-config.h index 3fedf8ab3cee..75ecdecf7013 100644 --- a/drivers/hwtracing/coresight/coresight-config.h +++ b/drivers/hwtracing/coresight/coresight-config.h @@ -164,4 +164,102 @@ struct cscfg_config_desc { const u64 *presets; /* nr_presets * nr_total_params */ }; +/** + * config register instance - part of a loaded feature. + * maps register values to csdev driver structures + * + * @value: value to use when setting feature on device / store for + * readback of volatile values. + * @drv_store: pointer to internal driver element used to set the value + * in hardware. + */ +struct cscfg_reg_csdev { + struct cscfg_regval_desc value; + void *drv_store; +}; + +/** + * config parameter instance - part of a loaded feature. + * + * @feat: parent feature + * @reg: register value updated by this parameter. + * @current_value: current value of parameter - may be set by user via + * sysfs, or modified during device operation. + * @val64: true if 64 bit value + */ +struct cscfg_parameter_csdev { + struct cscfg_feature_csdev *feat; + struct cscfg_reg_csdev *reg; + u64 current_value; + bool val64; +}; + +/** + * Feature instance loaded into a CoreSight device. + * + * When a feature is loaded into a specific device, then this structure holds + * the connections between the register / parameter values used and the + * internal data structures that are written when the feature is enabled. + * + * Since applying a feature modifies internal data structures in the device, + * then we have a reference to the device spinlock to protect access to these + * structures (@csdev_spinlock). + * + * @desc: pointer to the static descriptor for this feature. + * @csdev: parent CoreSight device instance. + * @node: list entry into feature list for this device. + * @csdev_spinlock: device spinlock from csdev instance.. + * @nr_params: number of parameters. + * @params: current parameter values on this device + * @nr_regs: number of registers to be programmed. + * @regs: Programming details for the registers + */ +struct cscfg_feature_csdev { + const struct cscfg_feature_desc *desc; + struct coresight_device *csdev; + struct list_head node; + spinlock_t *csdev_spinlock; + int nr_params; + struct cscfg_parameter_csdev *params; + int nr_regs; + struct cscfg_reg_csdev *regs; +}; + +/** + * Configuration instance when loaded into a CoreSight device. + * + * The instance contains references to loaded features on this device that are + * used by the configuration. + * + * @desc: reference to the descriptor for this configuration + * @csdev: parent coresight device for this configuration instance. + * @node: list entry within the coresight device + * @nr_feat: Number of features on this device that are used in the + * configuration. + * @feats: reference to the device features to enable. + * @enabled: true if configuration is enabled on this device. + */ +struct cscfg_config_csdev { + const struct cscfg_config_desc *desc; + struct coresight_device *csdev; + struct list_head node; + int nr_feat; + struct cscfg_feature_csdev **feats; + bool enabled; +}; + +/** + * Coresight device operations. + * + * Registered coresight devices provide these operations to manage feature + * instances compatible with the device hardware and drivers + * + * @load_feat: Pass a feature descriptor into the device and create the + * loaded feature instance (struct cscfg_feature_csdev). + */ +struct cscfg_csdev_feat_ops { + int (*load_feat)(struct coresight_device *csdev, + struct cscfg_feature_csdev *feat); +}; + #endif /* _CORESIGHT_CORESIGHT_CONFIG_H */ diff --git a/drivers/hwtracing/coresight/coresight-syscfg.c b/drivers/hwtracing/coresight/coresight-syscfg.c index f7e396a5f9cb..c04cea0c1db2 100644 --- a/drivers/hwtracing/coresight/coresight-syscfg.c +++ b/drivers/hwtracing/coresight/coresight-syscfg.c @@ -25,6 +25,212 @@ static struct cscfg_manager *cscfg_mgr; /* load features and configuations into the lists */ +/* protect the cfg lists in the csdev instances */ +static DEFINE_MUTEX(cscfg_csdev_mutex); + +/* get name feature instance from a coresight device list of features */ +static struct cscfg_feature_csdev * +cscfg_get_feat_csdev(struct coresight_device *csdev, const char *name) +{ + struct cscfg_feature_csdev *feat = NULL; + + list_for_each_entry(feat, &csdev->feature_csdev_list, node) { + if (strcmp(feat->desc->name, name) == 0) + return feat; + } + return NULL; +} + +/* allocate the device config instance - with max number of used features */ +static struct cscfg_config_csdev * +cscfg_alloc_csdev_cfg(struct coresight_device *csdev, int nr_feats) +{ + struct cscfg_config_csdev *dev_cfg = NULL; + struct device *dev = csdev->dev.parent; + + /* this is being allocated using the devm for the coresight device */ + dev_cfg = devm_kzalloc(dev, sizeof(struct cscfg_config_csdev), GFP_KERNEL); + if (!dev_cfg) + return NULL; + + dev_cfg->csdev = csdev; + dev_cfg->feats = devm_kcalloc(dev, nr_feats, + sizeof(struct cscfg_feature_csdev *), + GFP_KERNEL); + if (!dev_cfg->feats) + dev_cfg = NULL; + return dev_cfg; +} + +/* check match info between used feature from the config and a regisered device */ +static bool cscfg_match_feat_info(struct cscfg_match_desc *used_cmp, + struct cscfg_match_desc *reg_dev) +{ + /* if flags don't match then fail early */ + if (!(used_cmp->match_flags & reg_dev->match_flags)) + return false; + + return true; +} + +/* Load a config into a device if there are feature matches between config and device */ +static int cscfg_add_csdev_cfg(struct coresight_device *csdev, + struct cscfg_match_desc *match_info, + struct cscfg_config_desc *cfg_desc) +{ + struct cscfg_config_csdev *dev_cfg = NULL; + struct cscfg_config_feat_ref *feat_ref; + struct cscfg_feature_csdev *feat; + int checked; + + /* look at each required feature and see if it matches any feature on the device */ + for (checked = 0; checked < cfg_desc->nr_refs; checked++) { + feat_ref = &cfg_desc->refs[checked]; + if (cscfg_match_feat_info(&feat_ref->match, match_info)) { + /* device matched - get the feature */ + feat = cscfg_get_feat_csdev(csdev, feat_ref->name); + if (!feat) + return -EINVAL; + if (!dev_cfg) { + dev_cfg = cscfg_alloc_csdev_cfg(csdev, cfg_desc->nr_refs); + if (!dev_cfg) + return -ENOMEM; + dev_cfg->desc = cfg_desc; + } + dev_cfg->feats[dev_cfg->nr_feat++] = feat; + } + } + /* if matched features, add config to device.*/ + if (dev_cfg) { + mutex_lock(&cscfg_csdev_mutex); + list_add(&dev_cfg->node, &csdev->config_csdev_list); + mutex_unlock(&cscfg_csdev_mutex); + } + + return 0; +} + +/* + * Add the config to the set of registered devices - call with mutex locked. + * Iterates through devices - any device that matches one or more of the + * configuration features will load it, the others will ignore it. + */ +static int cscfg_add_cfg_to_csdevs(struct cscfg_config_desc *cfg_desc) +{ + struct cscfg_csdev_register *curr_item; + int err; + + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { + err = cscfg_add_csdev_cfg(curr_item->csdev, &curr_item->match_info, cfg_desc); + if (err) + return err; + } + return 0; +} + +/* + * Allocate a feature object for load into a csdev. + * memory allocated using the csdev->dev object using devm managed allocator. + */ +static struct cscfg_feature_csdev * +cscfg_alloc_csdev_feat(struct coresight_device *csdev, struct cscfg_feature_desc *feat_desc) +{ + struct cscfg_feature_csdev *feat = NULL; + struct device *dev = csdev->dev.parent; + int i; + + feat = devm_kzalloc(dev, sizeof(struct cscfg_feature_csdev), GFP_KERNEL); + if (!feat) + return NULL; + + /* parameters are optional - could be 0 */ + feat->nr_params = feat_desc->nr_params; + + /* + * if we need parameters, zero alloc the space here, the load routine in + * the csdev device driver will fill out some information according to + * feature descriptor. + */ + if (feat->nr_params) { + feat->params = devm_kcalloc(dev, feat->nr_params, + sizeof(struct cscfg_parameter_csdev), + GFP_KERNEL); + if (!feat->params) + return NULL; + + /* + * fill in the feature reference in the param - other fields + * handled by loader in csdev. + */ + for (i = 0; i < feat->nr_params; i++) + feat->params[i].feat = feat; + } + + /* + * Always have registers to program - again the load routine in csdev device + * will fill out according to feature descriptor and device requirements. + */ + feat->nr_regs = feat_desc->nr_regs; + feat->regs = devm_kcalloc(dev, feat->nr_regs, + sizeof(struct cscfg_reg_csdev), GFP_KERNEL); + if (!feat->regs) + return NULL; + + /* load the feature default values */ + feat->desc = feat_desc; + feat->csdev = csdev; + + return feat; +} + +/* load one feature into one coresight device */ +static int cscfg_load_feat_csdev(struct coresight_device *csdev, + struct cscfg_feature_desc *feat_desc, + struct cscfg_csdev_feat_ops *ops) +{ + struct cscfg_feature_csdev *feat_csdev; + int err; + + if (!ops->load_feat) + return -EINVAL; + + feat_csdev = cscfg_alloc_csdev_feat(csdev, feat_desc); + if (!feat_csdev) + return -ENOMEM; + + /* load the feature into the device - may modify default ops*/ + err = ops->load_feat(csdev, feat_csdev); + if (err) + return err; + + /* add to internal csdev feature list */ + mutex_lock(&cscfg_csdev_mutex); + list_add(&feat_csdev->node, &csdev->feature_csdev_list); + mutex_unlock(&cscfg_csdev_mutex); + + return 0; +} + +/* + * Add feature to any matching devices - call with mutex locked. + * Iterates through devices - any device that matches the feature will be + * called to load it. + */ +static int cscfg_add_feat_to_csdevs(struct cscfg_feature_desc *feat_desc) +{ + struct cscfg_csdev_register *curr_item; + int err; + + list_for_each_entry(curr_item, &cscfg_mgr->data.csdev_desc_list, item) { + if (curr_item->match_info.match_flags & feat_desc->match_flags) { + err = cscfg_load_feat_csdev(curr_item->csdev, feat_desc, &curr_item->ops); + if (err) + return err; + } + } + return 0; +} + /* check feature list for a named feature - call with mutex locked. */ static bool cscfg_match_list_feat(const char *name) { @@ -53,6 +259,13 @@ static int cscfg_check_feat_for_cfg(struct cscfg_config_desc *cfg_desc) */ static int cscfg_load_feat(struct cscfg_feature_desc *feat_desc) { + int err; + + /* add feature to any matching registered devices */ + err = cscfg_add_feat_to_csdevs(feat_desc); + if (err) + return err; + list_add(&feat_desc->item, &cscfg_mgr->data.feat_desc_list); return 0; @@ -71,6 +284,11 @@ static int cscfg_load_config(struct cscfg_config_desc *cfg_desc) if (err) return err; + /* add config to any matching registered device */ + err = cscfg_add_cfg_to_csdevs(cfg_desc); + if (err) + return err; + list_add(&cfg_desc->item, &cscfg_mgr->data.config_desc_list); return 0; @@ -122,6 +340,136 @@ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, } EXPORT_SYMBOL_GPL(cscfg_load_config_sets); +/* Handle coresight device registration and add configs and features to devices */ + +/* iterate through config lists and load matching configs to device */ +static int cscfg_add_cfgs_csdev(struct coresight_device *csdev, + struct cscfg_match_desc *info) +{ + struct cscfg_config_desc *curr_item; + int err = 0; + + list_for_each_entry(curr_item, &cscfg_mgr->data.config_desc_list, item) { + err = cscfg_add_csdev_cfg(csdev, info, curr_item); + if (err) + break; + } + return err; +} + +/* iterate through feature lists and load matching features to device */ +static int cscfg_add_feats_csdev(struct coresight_device *csdev, + struct cscfg_match_desc *info, + struct cscfg_csdev_feat_ops *ops) +{ + struct cscfg_feature_desc *curr_item; + int err = 0; + + if (!ops->load_feat) + return -EINVAL; + + list_for_each_entry(curr_item, &cscfg_mgr->data.feat_desc_list, item) { + if (curr_item->match_flags & info->match_flags) { + err = cscfg_load_feat_csdev(csdev, curr_item, ops); + if (err) + break; + } + } + return err; +} + +/* Add coresight device to list and copy its matching info */ +static int cscfg_list_add_csdev(struct coresight_device *csdev, + struct cscfg_match_desc *info, + struct cscfg_csdev_feat_ops *ops) +{ + struct cscfg_csdev_register *list_entry; + + /* allocate the list entry structure */ + list_entry = kzalloc(sizeof(struct cscfg_csdev_register), GFP_KERNEL); + if (!list_entry) + return -ENOMEM; + + list_entry->csdev = csdev; + list_entry->match_info.match_flags = info->match_flags; + list_entry->ops.load_feat = ops->load_feat; + list_add(&list_entry->item, &cscfg_mgr->data.csdev_desc_list); + + INIT_LIST_HEAD(&csdev->feature_csdev_list); + INIT_LIST_HEAD(&csdev->config_csdev_list); + cscfg_mgr->data.nr_csdev++; + + return 0; +} + +/* remove a coresight device from the list and free data */ +static void cscfg_list_remove_csdev(struct coresight_device *csdev) +{ + struct cscfg_csdev_register *curr_item, *tmp; + + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { + if (curr_item->csdev == csdev) { + list_del(&curr_item->item); + kfree(curr_item); + cscfg_mgr->data.nr_csdev--; + break; + } + } +} + +/* register a coresight device with the syscfg api */ +int cscfg_register_csdev(struct coresight_device *csdev, + struct cscfg_match_desc *info, + struct cscfg_csdev_feat_ops *ops) +{ + int ret = 0; + + mutex_lock(&cscfg_mutex); + + /* add device to list of registered devices */ + ret = cscfg_list_add_csdev(csdev, info, ops); + if (ret) + goto reg_csdev_unlock; + + /* now load any registered features and configs matching the device. */ + ret = cscfg_add_feats_csdev(csdev, info, ops); + if (ret) { + cscfg_list_remove_csdev(csdev); + goto reg_csdev_unlock; + } + + ret = cscfg_add_cfgs_csdev(csdev, info); + if (ret) { + cscfg_list_remove_csdev(csdev); + goto reg_csdev_unlock; + } + + pr_info("CSCFG registered %s", dev_name(&csdev->dev)); + +reg_csdev_unlock: + mutex_unlock(&cscfg_mutex); + return ret; +} +EXPORT_SYMBOL_GPL(cscfg_register_csdev); + +/* remove coresight device and update counts - syscfg device at 0 */ +void cscfg_unregister_csdev(struct coresight_device *csdev) +{ + struct cscfg_csdev_register *curr_item, *tmp; + + mutex_lock(&cscfg_mutex); + list_for_each_entry_safe(curr_item, tmp, &cscfg_mgr->data.csdev_desc_list, item) { + if (curr_item->csdev == csdev) { + list_del(&curr_item->item); + kfree(curr_item); + cscfg_mgr->data.nr_csdev--; + break; + } + } + mutex_unlock(&cscfg_mutex); +} +EXPORT_SYMBOL_GPL(cscfg_unregister_csdev); + /* Initialise system configuration management device. */ struct device *to_device_cscfg(void) diff --git a/drivers/hwtracing/coresight/coresight-syscfg.h b/drivers/hwtracing/coresight/coresight-syscfg.h index 907ba8d3efea..ebf5e1491d86 100644 --- a/drivers/hwtracing/coresight/coresight-syscfg.h +++ b/drivers/hwtracing/coresight/coresight-syscfg.h @@ -26,6 +26,22 @@ struct cscfg_api_data { int nr_csdev; }; +/** + * List entry for Coresight devices that are registered as supporting complex + * config operations. + * + * @csdev: The registered device. + * @match_info: The matching type information. + * @ops: Operations supported by the registered device. + * @item: list entry. + */ +struct cscfg_csdev_register { + struct coresight_device *csdev; + struct cscfg_match_desc match_info; + struct cscfg_csdev_feat_ops ops; + struct list_head item; +}; + /* internal core operations for cscfg */ int __init cscfg_init(void); void __exit cscfg_exit(void); @@ -33,6 +49,10 @@ void __exit cscfg_exit(void); /* syscfg manager external API */ int cscfg_load_config_sets(struct cscfg_config_desc **cfg_descs, struct cscfg_feature_desc **feat_descs); +int cscfg_register_csdev(struct coresight_device *csdev, + struct cscfg_match_desc *info, + struct cscfg_csdev_feat_ops *ops); +void cscfg_unregister_csdev(struct coresight_device *csdev); /** * System configuration manager device. diff --git a/include/linux/coresight.h b/include/linux/coresight.h index 976ec2697610..d0126ed326a6 100644 --- a/include/linux/coresight.h +++ b/include/linux/coresight.h @@ -219,6 +219,8 @@ struct coresight_sysfs_link { * @nr_links: number of sysfs links created to other components from this * device. These will appear in the "connections" group. * @has_conns_grp: Have added a "connections" group for sysfs links. + * @feature_csdev_list: List of complex feature programming added to the device. + * @config_csdev_list: List of system configurations added to the device. */ struct coresight_device { struct coresight_platform_data *pdata; @@ -240,6 +242,9 @@ struct coresight_device { int nr_links; bool has_conns_grp; bool ect_enabled; /* true only if associated ect device is enabled */ + /* system configuration and feature lists */ + struct list_head feature_csdev_list; + struct list_head config_csdev_list; }; /*
API for individual devices to register with the syscfg management system is added. Devices register with matching information, and any features or configurations that match will be loaded into the device. The feature and configuration loading is extended so that on load these are loaded into any currently registered devices. This allows configuration loading after devices have been registered. Signed-off-by: Mike Leach <mike.leach@linaro.org> --- .../hwtracing/coresight/coresight-config.h | 98 +++++ .../hwtracing/coresight/coresight-syscfg.c | 348 ++++++++++++++++++ .../hwtracing/coresight/coresight-syscfg.h | 20 + include/linux/coresight.h | 5 + 4 files changed, 471 insertions(+)