| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * |
| * Copyright (C) 2005 Mike Isely <isely@pobox.com> |
| */ |
| |
| #include <linux/string.h> |
| #include <linux/slab.h> |
| #include "pvrusb2-sysfs.h" |
| #include "pvrusb2-hdw.h" |
| #include "pvrusb2-debug.h" |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| #include "pvrusb2-debugifc.h" |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| |
| #define pvr2_sysfs_trace(...) pvr2_trace(PVR2_TRACE_SYSFS,__VA_ARGS__) |
| |
| struct pvr2_sysfs { |
| struct pvr2_channel channel; |
| struct device *class_dev; |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| struct pvr2_sysfs_debugifc *debugifc; |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| struct pvr2_sysfs_ctl_item *item_first; |
| struct pvr2_sysfs_ctl_item *item_last; |
| struct device_attribute attr_v4l_minor_number; |
| struct device_attribute attr_v4l_radio_minor_number; |
| struct device_attribute attr_unit_number; |
| struct device_attribute attr_bus_info; |
| struct device_attribute attr_hdw_name; |
| struct device_attribute attr_hdw_desc; |
| int v4l_minor_number_created_ok; |
| int v4l_radio_minor_number_created_ok; |
| int unit_number_created_ok; |
| int bus_info_created_ok; |
| int hdw_name_created_ok; |
| int hdw_desc_created_ok; |
| }; |
| |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| struct pvr2_sysfs_debugifc { |
| struct device_attribute attr_debugcmd; |
| struct device_attribute attr_debuginfo; |
| int debugcmd_created_ok; |
| int debuginfo_created_ok; |
| }; |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| |
| struct pvr2_sysfs_ctl_item { |
| struct device_attribute attr_name; |
| struct device_attribute attr_type; |
| struct device_attribute attr_min; |
| struct device_attribute attr_max; |
| struct device_attribute attr_def; |
| struct device_attribute attr_enum; |
| struct device_attribute attr_bits; |
| struct device_attribute attr_val; |
| struct device_attribute attr_custom; |
| struct pvr2_ctrl *cptr; |
| int ctl_id; |
| struct pvr2_sysfs *chptr; |
| struct pvr2_sysfs_ctl_item *item_next; |
| struct attribute *attr_gen[8]; |
| struct attribute_group grp; |
| int created_ok; |
| char name[80]; |
| }; |
| |
| static ssize_t show_name(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| const char *name; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_name); |
| name = pvr2_ctrl_get_desc(cip->cptr); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_name(cid=%d) is %s", |
| cip->chptr, cip->ctl_id, name); |
| if (!name) return -EINVAL; |
| return sysfs_emit(buf, "%s\n", name); |
| } |
| |
| static ssize_t show_type(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| const char *name; |
| enum pvr2_ctl_type tp; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_type); |
| tp = pvr2_ctrl_get_type(cip->cptr); |
| switch (tp) { |
| case pvr2_ctl_int: name = "integer"; break; |
| case pvr2_ctl_enum: name = "enum"; break; |
| case pvr2_ctl_bitmask: name = "bitmask"; break; |
| case pvr2_ctl_bool: name = "boolean"; break; |
| default: name = "?"; break; |
| } |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_type(cid=%d) is %s", |
| cip->chptr, cip->ctl_id, name); |
| return sysfs_emit(buf, "%s\n", name); |
| } |
| |
| static ssize_t show_min(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| long val; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_min); |
| val = pvr2_ctrl_get_min(cip->cptr); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_min(cid=%d) is %ld", |
| cip->chptr, cip->ctl_id, val); |
| return sysfs_emit(buf, "%ld\n", val); |
| } |
| |
| static ssize_t show_max(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| long val; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_max); |
| val = pvr2_ctrl_get_max(cip->cptr); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_max(cid=%d) is %ld", |
| cip->chptr, cip->ctl_id, val); |
| return sysfs_emit(buf, "%ld\n", val); |
| } |
| |
| static ssize_t show_def(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int val; |
| int ret; |
| unsigned int cnt = 0; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_def); |
| ret = pvr2_ctrl_get_def(cip->cptr, &val); |
| if (ret < 0) return ret; |
| ret = pvr2_ctrl_value_to_sym(cip->cptr, ~0, val, |
| buf, PAGE_SIZE - 1, &cnt); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_def(cid=%d) is %.*s (%d)", |
| cip->chptr, cip->ctl_id, cnt, buf, val); |
| buf[cnt] = '\n'; |
| return cnt + 1; |
| } |
| |
| static ssize_t show_val_norm(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int val; |
| int ret; |
| unsigned int cnt = 0; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_val); |
| ret = pvr2_ctrl_get_value(cip->cptr, &val); |
| if (ret < 0) return ret; |
| ret = pvr2_ctrl_value_to_sym(cip->cptr, ~0, val, |
| buf, PAGE_SIZE - 1, &cnt); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_val_norm(cid=%d) is %.*s (%d)", |
| cip->chptr, cip->ctl_id, cnt, buf, val); |
| buf[cnt] = '\n'; |
| return cnt+1; |
| } |
| |
| static ssize_t show_val_custom(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int val; |
| int ret; |
| unsigned int cnt = 0; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_custom); |
| ret = pvr2_ctrl_get_value(cip->cptr, &val); |
| if (ret < 0) return ret; |
| ret = pvr2_ctrl_custom_value_to_sym(cip->cptr, ~0, val, |
| buf, PAGE_SIZE - 1, &cnt); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_val_custom(cid=%d) is %.*s (%d)", |
| cip->chptr, cip->ctl_id, cnt, buf, val); |
| buf[cnt] = '\n'; |
| return cnt+1; |
| } |
| |
| static ssize_t show_enum(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| long val; |
| unsigned int bcnt, ccnt, ecnt; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_enum); |
| ecnt = pvr2_ctrl_get_cnt(cip->cptr); |
| bcnt = 0; |
| for (val = 0; val < ecnt; val++) { |
| pvr2_ctrl_get_valname(cip->cptr, val, buf + bcnt, |
| PAGE_SIZE - bcnt, &ccnt); |
| if (!ccnt) continue; |
| bcnt += ccnt; |
| if (bcnt >= PAGE_SIZE) break; |
| buf[bcnt] = '\n'; |
| bcnt++; |
| } |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_enum(cid=%d)", |
| cip->chptr, cip->ctl_id); |
| return bcnt; |
| } |
| |
| static ssize_t show_bits(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int valid_bits, msk; |
| unsigned int bcnt, ccnt; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_bits); |
| valid_bits = pvr2_ctrl_get_mask(cip->cptr); |
| bcnt = 0; |
| for (msk = 1; valid_bits; msk <<= 1) { |
| if (!(msk & valid_bits)) continue; |
| valid_bits &= ~msk; |
| pvr2_ctrl_get_valname(cip->cptr, msk, buf + bcnt, |
| PAGE_SIZE - bcnt, &ccnt); |
| bcnt += ccnt; |
| if (bcnt >= PAGE_SIZE) break; |
| buf[bcnt] = '\n'; |
| bcnt++; |
| } |
| pvr2_sysfs_trace("pvr2_sysfs(%p) show_bits(cid=%d)", |
| cip->chptr, cip->ctl_id); |
| return bcnt; |
| } |
| |
| static int store_val_any(struct pvr2_sysfs_ctl_item *cip, int customfl, |
| const char *buf,unsigned int count) |
| { |
| int ret; |
| int mask,val; |
| if (customfl) { |
| ret = pvr2_ctrl_custom_sym_to_value(cip->cptr, buf, count, |
| &mask, &val); |
| } else { |
| ret = pvr2_ctrl_sym_to_value(cip->cptr, buf, count, |
| &mask, &val); |
| } |
| if (ret < 0) return ret; |
| ret = pvr2_ctrl_set_mask_value(cip->cptr, mask, val); |
| pvr2_hdw_commit_ctl(cip->chptr->channel.hdw); |
| return ret; |
| } |
| |
| static ssize_t store_val_norm(struct device *class_dev, |
| struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int ret; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_val); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) store_val_norm(cid=%d) \"%.*s\"", |
| cip->chptr, cip->ctl_id, (int)count, buf); |
| ret = store_val_any(cip, 0, buf, count); |
| if (!ret) ret = count; |
| return ret; |
| } |
| |
| static ssize_t store_val_custom(struct device *class_dev, |
| struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| int ret; |
| cip = container_of(attr, struct pvr2_sysfs_ctl_item, attr_custom); |
| pvr2_sysfs_trace("pvr2_sysfs(%p) store_val_custom(cid=%d) \"%.*s\"", |
| cip->chptr, cip->ctl_id, (int)count, buf); |
| ret = store_val_any(cip, 1, buf, count); |
| if (!ret) ret = count; |
| return ret; |
| } |
| |
| static void pvr2_sysfs_add_control(struct pvr2_sysfs *sfp,int ctl_id) |
| { |
| struct pvr2_sysfs_ctl_item *cip; |
| struct pvr2_ctrl *cptr; |
| unsigned int cnt,acnt; |
| int ret; |
| |
| cptr = pvr2_hdw_get_ctrl_by_index(sfp->channel.hdw,ctl_id); |
| if (!cptr) return; |
| |
| cip = kzalloc(sizeof(*cip),GFP_KERNEL); |
| if (!cip) return; |
| pvr2_sysfs_trace("Creating pvr2_sysfs_ctl_item id=%p",cip); |
| |
| cip->cptr = cptr; |
| cip->ctl_id = ctl_id; |
| |
| cip->chptr = sfp; |
| cip->item_next = NULL; |
| if (sfp->item_last) { |
| sfp->item_last->item_next = cip; |
| } else { |
| sfp->item_first = cip; |
| } |
| sfp->item_last = cip; |
| |
| sysfs_attr_init(&cip->attr_name.attr); |
| cip->attr_name.attr.name = "name"; |
| cip->attr_name.attr.mode = S_IRUGO; |
| cip->attr_name.show = show_name; |
| |
| sysfs_attr_init(&cip->attr_type.attr); |
| cip->attr_type.attr.name = "type"; |
| cip->attr_type.attr.mode = S_IRUGO; |
| cip->attr_type.show = show_type; |
| |
| sysfs_attr_init(&cip->attr_min.attr); |
| cip->attr_min.attr.name = "min_val"; |
| cip->attr_min.attr.mode = S_IRUGO; |
| cip->attr_min.show = show_min; |
| |
| sysfs_attr_init(&cip->attr_max.attr); |
| cip->attr_max.attr.name = "max_val"; |
| cip->attr_max.attr.mode = S_IRUGO; |
| cip->attr_max.show = show_max; |
| |
| sysfs_attr_init(&cip->attr_def.attr); |
| cip->attr_def.attr.name = "def_val"; |
| cip->attr_def.attr.mode = S_IRUGO; |
| cip->attr_def.show = show_def; |
| |
| sysfs_attr_init(&cip->attr_val.attr); |
| cip->attr_val.attr.name = "cur_val"; |
| cip->attr_val.attr.mode = S_IRUGO; |
| |
| sysfs_attr_init(&cip->attr_custom.attr); |
| cip->attr_custom.attr.name = "custom_val"; |
| cip->attr_custom.attr.mode = S_IRUGO; |
| |
| sysfs_attr_init(&cip->attr_enum.attr); |
| cip->attr_enum.attr.name = "enum_val"; |
| cip->attr_enum.attr.mode = S_IRUGO; |
| cip->attr_enum.show = show_enum; |
| |
| sysfs_attr_init(&cip->attr_bits.attr); |
| cip->attr_bits.attr.name = "bit_val"; |
| cip->attr_bits.attr.mode = S_IRUGO; |
| cip->attr_bits.show = show_bits; |
| |
| if (pvr2_ctrl_is_writable(cptr)) { |
| cip->attr_val.attr.mode |= S_IWUSR|S_IWGRP; |
| cip->attr_custom.attr.mode |= S_IWUSR|S_IWGRP; |
| } |
| |
| acnt = 0; |
| cip->attr_gen[acnt++] = &cip->attr_name.attr; |
| cip->attr_gen[acnt++] = &cip->attr_type.attr; |
| cip->attr_gen[acnt++] = &cip->attr_val.attr; |
| cip->attr_gen[acnt++] = &cip->attr_def.attr; |
| cip->attr_val.show = show_val_norm; |
| cip->attr_val.store = store_val_norm; |
| if (pvr2_ctrl_has_custom_symbols(cptr)) { |
| cip->attr_gen[acnt++] = &cip->attr_custom.attr; |
| cip->attr_custom.show = show_val_custom; |
| cip->attr_custom.store = store_val_custom; |
| } |
| switch (pvr2_ctrl_get_type(cptr)) { |
| case pvr2_ctl_enum: |
| // Control is an enumeration |
| cip->attr_gen[acnt++] = &cip->attr_enum.attr; |
| break; |
| case pvr2_ctl_int: |
| // Control is an integer |
| cip->attr_gen[acnt++] = &cip->attr_min.attr; |
| cip->attr_gen[acnt++] = &cip->attr_max.attr; |
| break; |
| case pvr2_ctl_bitmask: |
| // Control is an bitmask |
| cip->attr_gen[acnt++] = &cip->attr_bits.attr; |
| break; |
| default: break; |
| } |
| |
| cnt = scnprintf(cip->name,sizeof(cip->name)-1,"ctl_%s", |
| pvr2_ctrl_get_name(cptr)); |
| cip->name[cnt] = 0; |
| cip->grp.name = cip->name; |
| cip->grp.attrs = cip->attr_gen; |
| |
| ret = sysfs_create_group(&sfp->class_dev->kobj,&cip->grp); |
| if (ret) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "sysfs_create_group error: %d", |
| ret); |
| return; |
| } |
| cip->created_ok = !0; |
| } |
| |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| static ssize_t debuginfo_show(struct device *, struct device_attribute *, |
| char *); |
| static ssize_t debugcmd_show(struct device *, struct device_attribute *, |
| char *); |
| static ssize_t debugcmd_store(struct device *, struct device_attribute *, |
| const char *, size_t count); |
| |
| static void pvr2_sysfs_add_debugifc(struct pvr2_sysfs *sfp) |
| { |
| struct pvr2_sysfs_debugifc *dip; |
| int ret; |
| |
| dip = kzalloc(sizeof(*dip),GFP_KERNEL); |
| if (!dip) return; |
| sysfs_attr_init(&dip->attr_debugcmd.attr); |
| dip->attr_debugcmd.attr.name = "debugcmd"; |
| dip->attr_debugcmd.attr.mode = S_IRUGO|S_IWUSR|S_IWGRP; |
| dip->attr_debugcmd.show = debugcmd_show; |
| dip->attr_debugcmd.store = debugcmd_store; |
| sysfs_attr_init(&dip->attr_debuginfo.attr); |
| dip->attr_debuginfo.attr.name = "debuginfo"; |
| dip->attr_debuginfo.attr.mode = S_IRUGO; |
| dip->attr_debuginfo.show = debuginfo_show; |
| sfp->debugifc = dip; |
| ret = device_create_file(sfp->class_dev,&dip->attr_debugcmd); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| dip->debugcmd_created_ok = !0; |
| } |
| ret = device_create_file(sfp->class_dev,&dip->attr_debuginfo); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| dip->debuginfo_created_ok = !0; |
| } |
| } |
| |
| |
| static void pvr2_sysfs_tear_down_debugifc(struct pvr2_sysfs *sfp) |
| { |
| if (!sfp->debugifc) return; |
| if (sfp->debugifc->debuginfo_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->debugifc->attr_debuginfo); |
| } |
| if (sfp->debugifc->debugcmd_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->debugifc->attr_debugcmd); |
| } |
| kfree(sfp->debugifc); |
| sfp->debugifc = NULL; |
| } |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| |
| |
| static void pvr2_sysfs_add_controls(struct pvr2_sysfs *sfp) |
| { |
| unsigned int idx,cnt; |
| cnt = pvr2_hdw_get_ctrl_count(sfp->channel.hdw); |
| for (idx = 0; idx < cnt; idx++) { |
| pvr2_sysfs_add_control(sfp,idx); |
| } |
| } |
| |
| |
| static void pvr2_sysfs_tear_down_controls(struct pvr2_sysfs *sfp) |
| { |
| struct pvr2_sysfs_ctl_item *cip1,*cip2; |
| for (cip1 = sfp->item_first; cip1; cip1 = cip2) { |
| cip2 = cip1->item_next; |
| if (cip1->created_ok) { |
| sysfs_remove_group(&sfp->class_dev->kobj,&cip1->grp); |
| } |
| pvr2_sysfs_trace("Destroying pvr2_sysfs_ctl_item id=%p",cip1); |
| kfree(cip1); |
| } |
| } |
| |
| |
| static void pvr2_sysfs_release(struct device *class_dev) |
| { |
| pvr2_sysfs_trace("Releasing class_dev id=%p",class_dev); |
| kfree(class_dev); |
| } |
| |
| |
| static struct class pvr2_class = { |
| .name = "pvrusb2", |
| .dev_release = pvr2_sysfs_release, |
| }; |
| |
| |
| static void class_dev_destroy(struct pvr2_sysfs *sfp) |
| { |
| struct device *dev; |
| if (!sfp->class_dev) return; |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| pvr2_sysfs_tear_down_debugifc(sfp); |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| pvr2_sysfs_tear_down_controls(sfp); |
| if (sfp->hdw_desc_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_hdw_desc); |
| } |
| if (sfp->hdw_name_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_hdw_name); |
| } |
| if (sfp->bus_info_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_bus_info); |
| } |
| if (sfp->v4l_minor_number_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_v4l_minor_number); |
| } |
| if (sfp->v4l_radio_minor_number_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_v4l_radio_minor_number); |
| } |
| if (sfp->unit_number_created_ok) { |
| device_remove_file(sfp->class_dev, |
| &sfp->attr_unit_number); |
| } |
| pvr2_sysfs_trace("Destroying class_dev id=%p",sfp->class_dev); |
| dev_set_drvdata(sfp->class_dev, NULL); |
| dev = sfp->class_dev->parent; |
| sfp->class_dev->parent = NULL; |
| put_device(dev); |
| device_unregister(sfp->class_dev); |
| sfp->class_dev = NULL; |
| } |
| |
| |
| static ssize_t v4l_minor_number_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%d\n", |
| pvr2_hdw_v4l_get_minor_number(sfp->channel.hdw, |
| pvr2_v4l_type_video)); |
| } |
| |
| |
| static ssize_t bus_info_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%s\n", |
| pvr2_hdw_get_bus_info(sfp->channel.hdw)); |
| } |
| |
| |
| static ssize_t hdw_name_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%s\n", |
| pvr2_hdw_get_type(sfp->channel.hdw)); |
| } |
| |
| |
| static ssize_t hdw_desc_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%s\n", |
| pvr2_hdw_get_desc(sfp->channel.hdw)); |
| } |
| |
| |
| static ssize_t v4l_radio_minor_number_show(struct device *class_dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%d\n", |
| pvr2_hdw_v4l_get_minor_number(sfp->channel.hdw, |
| pvr2_v4l_type_radio)); |
| } |
| |
| |
| static ssize_t unit_number_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return sysfs_emit(buf, "%d\n", |
| pvr2_hdw_get_unit_number(sfp->channel.hdw)); |
| } |
| |
| |
| static void class_dev_create(struct pvr2_sysfs *sfp) |
| { |
| struct usb_device *usb_dev; |
| struct device *class_dev; |
| int ret; |
| |
| usb_dev = pvr2_hdw_get_dev(sfp->channel.hdw); |
| if (!usb_dev) return; |
| class_dev = kzalloc(sizeof(*class_dev),GFP_KERNEL); |
| if (!class_dev) return; |
| |
| pvr2_sysfs_trace("Creating class_dev id=%p",class_dev); |
| |
| class_dev->class = &pvr2_class; |
| |
| dev_set_name(class_dev, "%s", |
| pvr2_hdw_get_device_identifier(sfp->channel.hdw)); |
| |
| class_dev->parent = get_device(&usb_dev->dev); |
| |
| sfp->class_dev = class_dev; |
| dev_set_drvdata(class_dev, sfp); |
| ret = device_register(class_dev); |
| if (ret) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_register failed"); |
| put_device(class_dev); |
| return; |
| } |
| |
| sysfs_attr_init(&sfp->attr_v4l_minor_number.attr); |
| sfp->attr_v4l_minor_number.attr.name = "v4l_minor_number"; |
| sfp->attr_v4l_minor_number.attr.mode = S_IRUGO; |
| sfp->attr_v4l_minor_number.show = v4l_minor_number_show; |
| sfp->attr_v4l_minor_number.store = NULL; |
| ret = device_create_file(sfp->class_dev, |
| &sfp->attr_v4l_minor_number); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->v4l_minor_number_created_ok = !0; |
| } |
| |
| sysfs_attr_init(&sfp->attr_v4l_radio_minor_number.attr); |
| sfp->attr_v4l_radio_minor_number.attr.name = "v4l_radio_minor_number"; |
| sfp->attr_v4l_radio_minor_number.attr.mode = S_IRUGO; |
| sfp->attr_v4l_radio_minor_number.show = v4l_radio_minor_number_show; |
| sfp->attr_v4l_radio_minor_number.store = NULL; |
| ret = device_create_file(sfp->class_dev, |
| &sfp->attr_v4l_radio_minor_number); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->v4l_radio_minor_number_created_ok = !0; |
| } |
| |
| sysfs_attr_init(&sfp->attr_unit_number.attr); |
| sfp->attr_unit_number.attr.name = "unit_number"; |
| sfp->attr_unit_number.attr.mode = S_IRUGO; |
| sfp->attr_unit_number.show = unit_number_show; |
| sfp->attr_unit_number.store = NULL; |
| ret = device_create_file(sfp->class_dev,&sfp->attr_unit_number); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->unit_number_created_ok = !0; |
| } |
| |
| sysfs_attr_init(&sfp->attr_bus_info.attr); |
| sfp->attr_bus_info.attr.name = "bus_info_str"; |
| sfp->attr_bus_info.attr.mode = S_IRUGO; |
| sfp->attr_bus_info.show = bus_info_show; |
| sfp->attr_bus_info.store = NULL; |
| ret = device_create_file(sfp->class_dev, |
| &sfp->attr_bus_info); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->bus_info_created_ok = !0; |
| } |
| |
| sysfs_attr_init(&sfp->attr_hdw_name.attr); |
| sfp->attr_hdw_name.attr.name = "device_hardware_type"; |
| sfp->attr_hdw_name.attr.mode = S_IRUGO; |
| sfp->attr_hdw_name.show = hdw_name_show; |
| sfp->attr_hdw_name.store = NULL; |
| ret = device_create_file(sfp->class_dev, |
| &sfp->attr_hdw_name); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->hdw_name_created_ok = !0; |
| } |
| |
| sysfs_attr_init(&sfp->attr_hdw_desc.attr); |
| sfp->attr_hdw_desc.attr.name = "device_hardware_description"; |
| sfp->attr_hdw_desc.attr.mode = S_IRUGO; |
| sfp->attr_hdw_desc.show = hdw_desc_show; |
| sfp->attr_hdw_desc.store = NULL; |
| ret = device_create_file(sfp->class_dev, |
| &sfp->attr_hdw_desc); |
| if (ret < 0) { |
| pvr2_trace(PVR2_TRACE_ERROR_LEGS, |
| "device_create_file error: %d", |
| ret); |
| } else { |
| sfp->hdw_desc_created_ok = !0; |
| } |
| |
| pvr2_sysfs_add_controls(sfp); |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| pvr2_sysfs_add_debugifc(sfp); |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |
| } |
| |
| |
| static void pvr2_sysfs_internal_check(struct pvr2_channel *chp) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = container_of(chp,struct pvr2_sysfs,channel); |
| if (!sfp->channel.mc_head->disconnect_flag) return; |
| pvr2_trace(PVR2_TRACE_STRUCT,"Destroying pvr2_sysfs id=%p",sfp); |
| class_dev_destroy(sfp); |
| pvr2_channel_done(&sfp->channel); |
| kfree(sfp); |
| } |
| |
| |
| void pvr2_sysfs_create(struct pvr2_context *mp) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = kzalloc(sizeof(*sfp),GFP_KERNEL); |
| if (!sfp) |
| return; |
| pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr2_sysfs id=%p",sfp); |
| pvr2_channel_init(&sfp->channel,mp); |
| sfp->channel.check_func = pvr2_sysfs_internal_check; |
| |
| class_dev_create(sfp); |
| } |
| |
| |
| void pvr2_sysfs_class_create(void) |
| { |
| if (class_register(&pvr2_class)) |
| pvr2_sysfs_trace("Registration failed for pvr2_sysfs_class"); |
| } |
| |
| |
| void pvr2_sysfs_class_destroy(void) |
| { |
| class_unregister(&pvr2_class); |
| } |
| |
| |
| #ifdef CONFIG_VIDEO_PVRUSB2_DEBUGIFC |
| static ssize_t debuginfo_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| pvr2_hdw_trigger_module_log(sfp->channel.hdw); |
| return pvr2_debugifc_print_info(sfp->channel.hdw,buf,PAGE_SIZE); |
| } |
| |
| |
| static ssize_t debugcmd_show(struct device *class_dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct pvr2_sysfs *sfp; |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| return pvr2_debugifc_print_status(sfp->channel.hdw,buf,PAGE_SIZE); |
| } |
| |
| |
| static ssize_t debugcmd_store(struct device *class_dev, |
| struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct pvr2_sysfs *sfp; |
| int ret; |
| |
| sfp = dev_get_drvdata(class_dev); |
| if (!sfp) return -EINVAL; |
| |
| ret = pvr2_debugifc_docmd(sfp->channel.hdw,buf,count); |
| if (ret < 0) return ret; |
| return count; |
| } |
| #endif /* CONFIG_VIDEO_PVRUSB2_DEBUGIFC */ |