From patchwork Sat Nov 4 06:46:48 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: huaweicloud X-Patchwork-Id: 161534 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a59:8f47:0:b0:403:3b70:6f57 with SMTP id j7csp1498742vqu; Fri, 3 Nov 2023 23:48:27 -0700 (PDT) X-Google-Smtp-Source: AGHT+IEKzykWXeoXkNrSqQbnAVfahd+2xldyZ1wixPrXzi5ZRrdHu66XQ0UBTMVSG4qmaclmdazx X-Received: by 2002:a05:6214:624:b0:673:72a4:b0bc with SMTP id a4-20020a056214062400b0067372a4b0bcmr15600473qvx.38.1699080506792; Fri, 03 Nov 2023 23:48:26 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1699080506; cv=none; d=google.com; s=arc-20160816; b=WnbU1kbSLs4nGyZ5B+jBUoJF14jgb9j+y+aB41Y/6VlRYBelpfKRjGYesVLORILa8T hODfmVMVOEIAfmiWlVqTJkHbJ7MwKQ02iNSQni+6gZU0QrdgDqGgUmQSYHiC9Y0qWiZj fkGeSYevfl3ZhHCy26Sis1GK5TgjYAmD2njGG62ozq0hRFaVvmNIu/Nd5kONGsvq5j4o ztQLrcUauynyWDApizpybxAOrpn00W+oKC67hUb0mAI7H+OfGsA2FP6Kzrug0U4QHFg6 SfzL8Ph5E6MTPVVm3bWzTF/Kv1k6Qyv8cPGP43arnGICSaJ0gFAf3afu0AkHtGYQJeES i/5A== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:mime-version :references:in-reply-to:message-id:date:subject:to:from; bh=gnKT5G8mfaymCp/EXZFEvbgFy3KNhiBIus/Ayu4orHg=; fh=d3qej8N8oEwoDi4946F/IhSPaeU492mqImsNcFeFjcI=; b=I9mjkG57O1BNfCW/ohMqQmAKAS7MPPt7vYtbsxYzx7sVC3SYVC5mLoo/dH9wenOD+9 /6kTBvccWbEOXNlyw36k+9MJyKSU6kKnbz+JcLJQ/tjiymsgTwPiwfOYqrn/+Q6aWi7p iMwTGOOpdmME9xWliuBM6nJJmjDT7pIuXlbp/dn3Xh8Fij6nS3Q5Yx8dWoJSXUakx0Af wXpu+35PSk/VGkj1gEutADPcW5/AvcBdQoFQpReDqZm+ltbOrsmy6T0UBRcf7TMMhwBV 3VAPgBHQQkZKK0oCjisknPjTKLk7VNChRfXh60V/Br8olEFpJExs4lJSY3PA5bGSxOAO X47Q== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::3:3 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: from lipwig.vger.email (lipwig.vger.email. [2620:137:e000::3:3]) by mx.google.com with ESMTPS id e7-20020a6558c7000000b0056336fb99aasi3062562pgu.850.2023.11.03.23.48.26 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 03 Nov 2023 23:48:26 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::3:3 as permitted sender) client-ip=2620:137:e000::3:3; Authentication-Results: mx.google.com; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::3:3 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: from out1.vger.email (depot.vger.email [IPv6:2620:137:e000::3:0]) by lipwig.vger.email (Postfix) with ESMTP id 0E5FF80E7611; Fri, 3 Nov 2023 23:48:24 -0700 (PDT) X-Virus-Status: Clean X-Virus-Scanned: clamav-milter 0.103.10 at lipwig.vger.email Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231734AbjKDGrc (ORCPT + 35 others); Sat, 4 Nov 2023 02:47:32 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:52950 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229661AbjKDGr1 (ORCPT ); Sat, 4 Nov 2023 02:47:27 -0400 Received: from dggsgout11.his.huawei.com (unknown [45.249.212.51]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id C13E7D4C; Fri, 3 Nov 2023 23:47:23 -0700 (PDT) Received: from mail.maildlp.com (unknown [172.19.93.142]) by dggsgout11.his.huawei.com (SkyGuard) with ESMTP id 4SMp7p4MR3z4f3jqq; Sat, 4 Nov 2023 14:47:18 +0800 (CST) Received: from mail02.huawei.com (unknown [10.116.40.128]) by mail.maildlp.com (Postfix) with ESMTP id CA72A1A0172; Sat, 4 Nov 2023 14:47:20 +0800 (CST) Received: from huaweicloud.com (unknown [10.175.101.107]) by APP4 (Coremail) with SMTP id gCh0CgDnfd3z6EVlglQtEw--.50758S7; Sat, 04 Nov 2023 14:47:20 +0800 (CST) From: Zhang Xiaoxu To: zhangxiaoxu5@huawei.com, weiyongjun1@huawei.com, broonie@kernel.org, rostedt@goodmis.org, mingo@redhat.com, frowand.list@gmail.com, linux-spi@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH v3 -next 3/5] spi: mockup: Add support register the device through configfs Date: Sat, 4 Nov 2023 14:46:48 +0800 Message-Id: <20231104064650.972687-4-zhangxiaoxu@huaweicloud.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20231104064650.972687-1-zhangxiaoxu@huaweicloud.com> References: <20231104064650.972687-1-zhangxiaoxu@huaweicloud.com> MIME-Version: 1.0 X-CM-TRANSID: gCh0CgDnfd3z6EVlglQtEw--.50758S7 X-Coremail-Antispam: 1UD129KBjvJXoW3AF47Jw4rGF13Jw1xurW3KFg_yoW7Zw4DpF Z8AFy5trW8GFs8WF4fC34kuF95Gr1xKr4Uta43Aw1FkwnrAry8Zas7WFyYyr48JFWDGF47 ZFWfZF10krWjvrUanT9S1TB71UUUUU7qnTZGkaVYY2UrUUUUjbIjqfuFe4nvWSU5nxnvy2 9KBjDU0xBIdaVrnRJUUUvGb4IE77IF4wAFF20E14v26rWj6s0DM7CY07I20VC2zVCF04k2 6cxKx2IYs7xG6rWj6s0DM7CIcVAFz4kK6r1j6r18M28IrcIa0xkI8VA2jI8067AKxVWUWw A2048vs2IY020Ec7CjxVAFwI0_Xr0E3s1l8cAvFVAK0II2c7xJM28CjxkF64kEwVA0rcxS w2x7M28EF7xvwVC0I7IYx2IY67AKxVWDJVCq3wA2z4x0Y4vE2Ix0cI8IcVCY1x0267AKxV W8Jr0_Cr1UM28EF7xvwVC2z280aVAFwI0_GcCE3s1l84ACjcxK6I8E87Iv6xkF7I0E14v2 6rxl6s0DM2AIxVAIcxkEcVAq07x20xvEncxIr21l5I8CrVACY4xI64kE6c02F40Ex7xfMc Ij6xIIjxv20xvE14v26r1Y6r17McIj6I8E87Iv67AKxVWUJVW8JwAm72CE4IkC6x0Yz7v_ Jr0_Gr1lF7xvr2IYc2Ij64vIr41l42xK82IYc2Ij64vIr41l4I8I3I0E4IkC6x0Yz7v_Jr 0_Gr1lx2IqxVAqx4xG67AKxVWUJVWUGwC20s026x8GjcxK67AKxVWUGVWUWwC2zVAF1VAY 17CE14v26r1q6r43MIIYrxkI7VAKI48JMIIF0xvE2Ix0cI8IcVAFwI0_JFI_Gr1lIxAIcV C0I7IYx2IY6xkF7I0E14v26r4j6F4UMIIF0xvE42xK8VAvwI8IcIk0rVWUJVWUCwCI42IY 6I8E87Iv67AKxVWUJVW8JwCI42IY6I8E87Iv6xkF7I0E14v26r4j6r4UJbIYCTnIWIevJa 73UjIFyTuYvjxUrfOzDUUUU X-CM-SenderInfo: x2kd0wp0ld053x6k3tpzhluzxrxghudrp/ X-Spam-Status: No, score=-0.8 required=5.0 tests=HEADER_FROM_DIFFERENT_DOMAINS, MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,T_SCC_BODY_TEXT_LINE, URIBL_BLOCKED autolearn=unavailable autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lipwig.vger.email Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (lipwig.vger.email [0.0.0.0]); Fri, 03 Nov 2023 23:48:24 -0700 (PDT) X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1781615041164740277 X-GMAIL-MSGID: 1781615041164740277 From: Zhang Xiaoxu This enable/disable the spi mockup device through the configfs: mkdir /sys/kernel/config/spi-mockup/spi0 echo 1 > /sys/kernel/config/spi-mockup/spi0/enable echo 1 > /sys/kernel/config/spi-mockup/spi0/disable Signed-off-by: Zhang Xiaoxu --- drivers/spi/spi-mockup.c | 163 ++++++++++++++++++++++++++++++++++++++- 1 file changed, 161 insertions(+), 2 deletions(-) diff --git a/drivers/spi/spi-mockup.c b/drivers/spi/spi-mockup.c index fcaaa61bdb38..b449a2b7cdd4 100644 --- a/drivers/spi/spi-mockup.c +++ b/drivers/spi/spi-mockup.c @@ -12,6 +12,7 @@ #include #include #include +#include #define CREATE_TRACE_POINTS #include @@ -224,7 +225,7 @@ static int spi_mockup_probe(struct platform_device *pdev) ctrl->dev.groups = spi_mockup_groups; ctrl->num_chipselect = MOCKUP_CHIPSELECT_MAX; ctrl->mode_bits = SPI_MODE_USER_MASK; - ctrl->bus_num = 0; + ctrl->bus_num = pdev->id; ctrl->transfer_one_message = spi_mockup_transfer; mock = spi_controller_get_devdata(ctrl); @@ -252,7 +253,165 @@ static struct platform_driver spi_mockup_driver = { .of_match_table = spi_mockup_match, }, }; -module_platform_driver(spi_mockup_driver); + +struct spi_mockup_device { + struct config_group group; + unsigned int bus_nr; + struct mutex lock; + struct platform_device *pdev; +}; + +static struct spi_mockup_device *to_spi_mockup_dev(struct config_item *item) +{ + struct config_group *group = to_config_group(item); + + return container_of(group, struct spi_mockup_device, group); +} + +static ssize_t +spi_mockup_enable_store(struct config_item *item, const char *page, size_t len) +{ + int ret = len; + struct platform_device_info pdevinfo = {0}; + struct spi_mockup_device *dev = to_spi_mockup_dev(item); + + mutex_lock(&dev->lock); + if (dev->pdev) { + ret = -EEXIST; + goto out; + } + + pdevinfo.name = "spi-mockup"; + pdevinfo.id = dev->bus_nr; + dev->pdev = platform_device_register_full(&pdevinfo); + if (IS_ERR(dev->pdev)) { + ret = PTR_ERR(dev->pdev); + dev->pdev = NULL; + goto out; + } +out: + mutex_unlock(&dev->lock); + return ret; +} +CONFIGFS_ATTR_WO(spi_mockup_, enable); + +static ssize_t +spi_mockup_disable_store(struct config_item *item, const char *page, size_t len) +{ + int ret = len; + struct spi_mockup_device *dev = to_spi_mockup_dev(item); + + mutex_lock(&dev->lock); + if (!dev->pdev) { + ret = -ENODEV; + goto out; + } + + platform_device_unregister(dev->pdev); + dev->pdev = NULL; +out: + mutex_unlock(&dev->lock); + return ret; +} +CONFIGFS_ATTR_WO(spi_mockup_, disable); + +static struct configfs_attribute *spi_mockup_configfs_attrs[] = { + &spi_mockup_attr_enable, + &spi_mockup_attr_disable, + NULL, +}; + +static const struct config_item_type spi_mockup_device_config_group_type = { + .ct_owner = THIS_MODULE, + .ct_attrs = spi_mockup_configfs_attrs, +}; + +static struct config_group * +spi_mockup_config_make_device_group(struct config_group *group, + const char *name) +{ + int ret, nchar; + unsigned int nr; + struct spi_mockup_device *dev; + + ret = sscanf(name, "spi%u%n", &nr, &nchar); + if (ret != 1 || nchar != strlen(name)) + return ERR_PTR(-EINVAL); + + dev = kzalloc(sizeof(*dev), GFP_KERNEL); + if (!dev) + return ERR_PTR(-ENOMEM); + + dev->bus_nr = nr; + mutex_init(&dev->lock); + + config_group_init_type_name(&dev->group, name, + &spi_mockup_device_config_group_type); + + return &dev->group; +} + +static void spi_mockup_config_group_release(struct config_item *item) +{ + struct spi_mockup_device *dev = to_spi_mockup_dev(item); + + kfree(dev); +} + +static struct configfs_item_operations spi_mockup_config_item_ops = { + .release = spi_mockup_config_group_release, +}; + +static struct configfs_group_operations spi_mockup_config_group_ops = { + .make_group = spi_mockup_config_make_device_group, +}; + +static const struct config_item_type spi_mockup_config_type = { + .ct_owner = THIS_MODULE, + .ct_group_ops = &spi_mockup_config_group_ops, + .ct_item_ops = &spi_mockup_config_item_ops, +}; + +static struct configfs_subsystem spi_mockup_config_subsys = { + .su_group = { + .cg_item = { + .ci_namebuf = "spi-mockup", + .ci_type = &spi_mockup_config_type, + } + } +}; + +static int __init spi_mockup_init(void) +{ + int ret; + + ret = platform_driver_register(&spi_mockup_driver); + if (ret) { + pr_err("spi mockup driver registering failed with %d\n", ret); + return ret; + } + + config_group_init(&spi_mockup_config_subsys.su_group); + mutex_init(&spi_mockup_config_subsys.su_mutex); + ret = configfs_register_subsystem(&spi_mockup_config_subsys); + if (ret) { + pr_err("spi mockup configfs registering failed with %d\n", ret); + mutex_destroy(&spi_mockup_config_subsys.su_mutex); + platform_driver_unregister(&spi_mockup_driver); + return ret; + } + + return ret; +} +module_init(spi_mockup_init); + +static void __exit spi_mockup_exit(void) +{ + configfs_unregister_subsystem(&spi_mockup_config_subsys); + mutex_destroy(&spi_mockup_config_subsys.su_mutex); + return platform_driver_unregister(&spi_mockup_driver); +} +module_exit(spi_mockup_exit); MODULE_AUTHOR("Wei Yongjun "); MODULE_DESCRIPTION("SPI controller Testing Driver");