From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-16.4 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_CR_TRAILER,INCLUDES_PATCH,MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS, URIBL_BLOCKED autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id D5211C4338F for ; Fri, 20 Aug 2021 18:08:37 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id BB00B6115A for ; Fri, 20 Aug 2021 18:08:37 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S236077AbhHTSJN (ORCPT ); Fri, 20 Aug 2021 14:09:13 -0400 Received: from us-smtp-delivery-124.mimecast.com ([170.10.133.124]:57350 "EHLO us-smtp-delivery-124.mimecast.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229512AbhHTSJG (ORCPT ); Fri, 20 Aug 2021 14:09:06 -0400 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=redhat.com; s=mimecast20190719; t=1629482907; h=from:from:reply-to:subject:subject:date:date:message-id:message-id: to:to:cc:cc:mime-version:mime-version: content-transfer-encoding:content-transfer-encoding: in-reply-to:in-reply-to:references:references; bh=SpZr87XzyOz+3F4mNP62XbHTTPHA5JGwo0NURRcTIow=; b=iAH37HO4nA63Joj3ka1T0iDYDu3K30qyYnBP8oYUYc6UOtGm+6/TbV3SScGFGrEO3CZb5D qtERVceFxies5Eby4b6sMBy2zwK3IBmDJV9ckmKx4MNtupuiRLrt7PTvFYT3YNlVMMhSS7 BDMIQ2BG1ik7fghTiE3g6CGGifGgzUA= Received: from mimecast-mx01.redhat.com (mimecast-mx01.redhat.com [209.132.183.4]) (Using TLS) by relay.mimecast.com with ESMTP id us-mta-190-b45HFxMLNSmwDpnDEcdmiQ-1; Fri, 20 Aug 2021 14:08:26 -0400 X-MC-Unique: b45HFxMLNSmwDpnDEcdmiQ-1 Received: from smtp.corp.redhat.com (int-mx04.intmail.prod.int.phx2.redhat.com [10.5.11.14]) (using TLSv1.2 with cipher AECDH-AES256-SHA (256/256 bits)) (No client certificate requested) by mimecast-mx01.redhat.com (Postfix) with ESMTPS id 872291008060; Fri, 20 Aug 2021 18:08:25 +0000 (UTC) Received: from cmirabil.remote.csb (unknown [10.22.9.218]) by smtp.corp.redhat.com (Postfix) with ESMTP id 838925D9D5; Fri, 20 Aug 2021 18:08:24 +0000 (UTC) From: Charles Mirabile To: linux-kernel@vger.kernel.org Cc: Charles Mirabile , Miguel Ojeda , Serge Schneider , Stefan Wahren , Nicolas Saenz Julienne , linux-rpi-kernel@lists.infradead.org, fedora-rpi@googlegroups.com, Mwesigwa Guma , Joel Savitz Subject: [RFC PATCH v2 3/4] drivers/auxdisplay: senshat Raspberry Pi Sense HAT display driver Date: Fri, 20 Aug 2021 14:08:00 -0400 Message-Id: <20210820180801.561119-4-cmirabil@redhat.com> In-Reply-To: <20210820180801.561119-1-cmirabil@redhat.com> References: <20210820180801.561119-1-cmirabil@redhat.com> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Scanned-By: MIMEDefang 2.79 on 10.5.11.14 Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org This patch implements control of the 8x8 RGB LED matrix display. Signed-off-by: Charles Mirabile Signed-off-by: Mwesigwa Guma Signed-off-by: Joel Savitz --- drivers/auxdisplay/Kconfig | 7 + drivers/auxdisplay/Makefile | 1 + drivers/auxdisplay/sensehat-display.c | 233 ++++++++++++++++++++++++++ 3 files changed, 241 insertions(+) create mode 100644 drivers/auxdisplay/sensehat-display.c diff --git a/drivers/auxdisplay/Kconfig b/drivers/auxdisplay/Kconfig index 1509cb74705a..24f5d68cfbff 100644 --- a/drivers/auxdisplay/Kconfig +++ b/drivers/auxdisplay/Kconfig @@ -193,6 +193,13 @@ config ARM_CHARLCD line and the Linux version on the second line, but that's still useful. +config SENSEHAT_DISPLAY + tristate "Raspberry pi Sense HAT display driver" + select MFD_SENSEHAT_CORE + help + This is a driver for the Raspberry Pi Sensehat 8x8 RBG-LED matrix + you can access it as a misc device at /dev/sense-hat + menuconfig PARPORT_PANEL tristate "Parallel port LCD/Keypad Panel support" depends on PARPORT diff --git a/drivers/auxdisplay/Makefile b/drivers/auxdisplay/Makefile index 307771027c89..7e9aa479586a 100644 --- a/drivers/auxdisplay/Makefile +++ b/drivers/auxdisplay/Makefile @@ -13,3 +13,4 @@ obj-$(CONFIG_HD44780) += hd44780.o obj-$(CONFIG_HT16K33) += ht16k33.o obj-$(CONFIG_PARPORT_PANEL) += panel.o obj-$(CONFIG_LCD2S) += lcd2s.o +obj-$(CONFIG_SENSEHAT_DISPLAY) += sensehat-display.o diff --git a/drivers/auxdisplay/sensehat-display.c b/drivers/auxdisplay/sensehat-display.c new file mode 100644 index 000000000000..8a618a198351 --- /dev/null +++ b/drivers/auxdisplay/sensehat-display.c @@ -0,0 +1,233 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * Raspberry Pi Sense HAT 8x8 LED matrix display driver + * http://raspberrypi.org + * + * Copyright (C) 2015 Raspberry Pi + * Copyright (C) 2021 Charles Mirabile, Mwesigwa Guma, Joel Savitz + * + * Original Author: Serge Schneider + * Revised for upstream Linux by: Charles Mirabile, Mwesigwa Guma, Joel Savitz + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#define GAMMA_SIZE sizeof_field(struct sensehat_display, gamma) +#define VMEM_SIZE sizeof_field(struct sensehat_display, vmem) + +static bool lowlight; +module_param(lowlight, bool, 0); +MODULE_PARM_DESC(lowlight, "Reduce LED matrix brightness to one third"); + +static const u8 gamma_presets[][GAMMA_SIZE] = { + [GAMMA_DEFAULT] = { + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x01, + 0x02, 0x02, 0x03, 0x03, 0x04, 0x05, 0x06, 0x07, + 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0E, 0x0F, 0x11, + 0x12, 0x14, 0x15, 0x17, 0x19, 0x1B, 0x1D, 0x1F, + }, + [GAMMA_LOWLIGHT] = { + 0x00, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, + 0x03, 0x03, 0x03, 0x04, 0x04, 0x05, 0x05, 0x06, + 0x06, 0x07, 0x07, 0x08, 0x08, 0x09, 0x0A, 0x0A, + }, +}; + +static const struct file_operations sensehat_display_fops; + +static int sensehat_display_probe(struct platform_device *pdev) +{ + int ret; + + struct sensehat *sensehat = dev_get_drvdata(&pdev->dev); + struct sensehat_display *sensehat_display = &sensehat->display; + + memcpy(sensehat_display->gamma, gamma_presets[lowlight], GAMMA_SIZE); + + memset(sensehat_display->vmem, 0, VMEM_SIZE); + + mutex_init(&sensehat_display->rw_mtx); + + sensehat_display->mdev = (struct miscdevice) { + .minor = MISC_DYNAMIC_MINOR, + .name = "sense-hat", + .mode = 0666, + .fops = &sensehat_display_fops, + }; + + ret = misc_register(&sensehat_display->mdev); + if (ret < 0) { + dev_err(&pdev->dev, "Could not register 8x8 LED matrix display.\n"); + return ret; + } + + dev_info(&pdev->dev, "8x8 LED matrix display registered with minor number %i", + sensehat_display->mdev.minor); + + sensehat_update_display(sensehat); + return 0; +} + +static int sensehat_display_remove(struct platform_device *pdev) +{ + struct sensehat *sensehat = dev_get_drvdata(&pdev->dev); + struct sensehat_display *sensehat_display = &sensehat->display; + + misc_deregister(&sensehat_display->mdev); + return 0; +} + +static loff_t sensehat_display_llseek(struct file *filp, loff_t pos, int whence) +{ + loff_t base; + + switch (whence) { + case SEEK_SET: + base = 0; + break; + case SEEK_CUR: + base = filp->f_pos; + break; + case SEEK_END: + base = VMEM_SIZE; + break; + default: + return -EINVAL; + } + base += pos; + if (base < 0 || base >= VMEM_SIZE) + return -EINVAL; + filp->f_pos = base; + return base; +} + +static ssize_t +sensehat_display_read(struct file *filp, char __user *buf, size_t count, loff_t *f_pos) +{ + struct sensehat *sensehat = container_of(filp->private_data, struct sensehat, display.mdev); + struct sensehat_display *sensehat_display = &sensehat->display; + ssize_t retval = -EFAULT; + + if (*f_pos >= VMEM_SIZE) + return 0; + if (*f_pos + count > VMEM_SIZE) + count = VMEM_SIZE - *f_pos; + if (mutex_lock_interruptible(&sensehat_display->rw_mtx)) + return -ERESTARTSYS; + if (copy_to_user(buf, sensehat_display->vmem + *f_pos, count)) + goto out; + *f_pos += count; + retval = count; +out: + mutex_unlock(&sensehat_display->rw_mtx); + return retval; +} + +static ssize_t +sensehat_display_write(struct file *filp, const char __user *buf, size_t count, loff_t *f_pos) +{ + struct sensehat *sensehat = container_of(filp->private_data, struct sensehat, display.mdev); + struct sensehat_display *sensehat_display = &sensehat->display; + u8 temp[VMEM_SIZE]; + + if (*f_pos >= VMEM_SIZE) + return -EFBIG; + if (*f_pos + count > VMEM_SIZE) + count = VMEM_SIZE - *f_pos; + if (copy_from_user(temp, buf, count)) + return -EFAULT; + if (mutex_lock_interruptible(&sensehat_display->rw_mtx)) + return -ERESTARTSYS; + memcpy(sensehat_display->vmem + *f_pos, temp, count); + sensehat_update_display(sensehat); + *f_pos += count; + mutex_unlock(&sensehat_display->rw_mtx); + return count; +} + +static long sensehat_display_ioctl(struct file *filp, unsigned int cmd, + unsigned long arg) +{ + struct sensehat *sensehat = container_of(filp->private_data, struct sensehat, display.mdev); + struct sensehat_display *sensehat_display = &sensehat->display; + void __user *user_ptr = (void __user *)arg; + u8 temp[GAMMA_SIZE]; + int ret; + + if (mutex_lock_interruptible(&sensehat_display->rw_mtx)) + return -ERESTARTSYS; + switch (cmd) { + case SENSEDISP_IOGET_GAMMA: + if (copy_to_user(user_ptr, sensehat_display->gamma, GAMMA_SIZE)) { + ret = -EFAULT; + goto out_unlock; + } + ret = 0; + goto out_unlock; + case SENSEDISP_IOSET_GAMMA: + if (copy_from_user(temp, user_ptr, GAMMA_SIZE)) { + ret = -EFAULT; + goto out_unlock; + } + ret = 0; + goto out_update; + case SENSEDISP_IORESET_GAMMA: + if (arg < GAMMA_DEFAULT || arg >= GAMMA_PRESET_COUNT) { + ret = -EINVAL; + goto out_unlock; + } + memcpy(temp, gamma_presets[arg], GAMMA_SIZE); + ret = 0; + goto out_update; + default: + ret = -EINVAL; + goto out_unlock; + } +out_update: + memcpy(sensehat_display->gamma, temp, GAMMA_SIZE); + sensehat_update_display(sensehat); +out_unlock: + mutex_unlock(&sensehat_display->rw_mtx); + return ret; +} + +static const struct file_operations sensehat_display_fops = { + .owner = THIS_MODULE, + .llseek = sensehat_display_llseek, + .read = sensehat_display_read, + .write = sensehat_display_write, + .unlocked_ioctl = sensehat_display_ioctl, +}; + +static struct platform_device_id sensehat_display_device_id[] = { + { .name = "sensehat-display" }, + { }, +}; +MODULE_DEVICE_TABLE(platform, sensehat_display_device_id); + +static struct platform_driver sensehat_display_driver = { + .probe = sensehat_display_probe, + .remove = sensehat_display_remove, + .driver = { + .name = "sensehat-display", + }, +}; + +module_platform_driver(sensehat_display_driver); + +MODULE_DESCRIPTION("Raspberry Pi Sense HAT 8x8 LED matrix display driver"); +MODULE_AUTHOR("Serge Schneider "); +MODULE_LICENSE("GPL"); -- 2.27.0