mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
270 lines
7.5 KiB
270 lines
7.5 KiB
// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause |
|
/** |
|
* rpivid-mem.c - character device access to the RPiVid decoder registers |
|
* |
|
* Based on bcm2835-gpiomem.c. Provides IO memory access to the decoder |
|
* register blocks such that ffmpeg plugins can access the hardware. |
|
* |
|
* Jonathan Bell <[email protected]> |
|
* Copyright (c) 2019, Raspberry Pi (Trading) Ltd. |
|
* |
|
* Redistribution and use in source and binary forms, with or without |
|
* modification, are permitted provided that the following conditions |
|
* are met: |
|
* 1. Redistributions of source code must retain the above copyright |
|
* notice, this list of conditions, and the following disclaimer, |
|
* without modification. |
|
* 2. Redistributions in binary form must reproduce the above copyright |
|
* notice, this list of conditions and the following disclaimer in the |
|
* documentation and/or other materials provided with the distribution. |
|
* 3. The names of the above-listed copyright holders may not be used |
|
* to endorse or promote products derived from this software without |
|
* specific prior written permission. |
|
* |
|
* ALTERNATIVELY, this software may be distributed under the terms of the |
|
* GNU General Public License ("GPL") version 2, as published by the Free |
|
* Software Foundation. |
|
* |
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS |
|
* IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, |
|
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR |
|
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, |
|
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, |
|
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR |
|
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF |
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
#include <linux/of.h> |
|
#include <linux/of_device.h> |
|
#include <linux/platform_device.h> |
|
#include <linux/mm.h> |
|
#include <linux/slab.h> |
|
#include <linux/cdev.h> |
|
#include <linux/pagemap.h> |
|
#include <linux/io.h> |
|
|
|
#define DRIVER_NAME "rpivid-mem" |
|
#define DEVICE_MINOR 0 |
|
|
|
struct rpivid_mem_priv { |
|
dev_t devid; |
|
struct class *class; |
|
struct cdev rpivid_mem_cdev; |
|
unsigned long regs_phys; |
|
unsigned long mem_window_len; |
|
struct device *dev; |
|
const char *name; |
|
}; |
|
|
|
static int rpivid_mem_open(struct inode *inode, struct file *file) |
|
{ |
|
int dev = iminor(inode); |
|
int ret = 0; |
|
struct rpivid_mem_priv *priv; |
|
|
|
if (dev != DEVICE_MINOR && dev != DEVICE_MINOR + 1) |
|
ret = -ENXIO; |
|
|
|
priv = container_of(inode->i_cdev, struct rpivid_mem_priv, |
|
rpivid_mem_cdev); |
|
if (!priv) |
|
return -EINVAL; |
|
file->private_data = priv; |
|
return ret; |
|
} |
|
|
|
static int rpivid_mem_release(struct inode *inode, struct file *file) |
|
{ |
|
int dev = iminor(inode); |
|
int ret = 0; |
|
|
|
if (dev != DEVICE_MINOR && dev != DEVICE_MINOR + 1) |
|
ret = -ENXIO; |
|
|
|
return ret; |
|
} |
|
|
|
static const struct vm_operations_struct rpivid_mem_vm_ops = { |
|
#ifdef CONFIG_HAVE_IOREMAP_PROT |
|
.access = generic_access_phys |
|
#endif |
|
}; |
|
|
|
static int rpivid_mem_mmap(struct file *file, struct vm_area_struct *vma) |
|
{ |
|
struct rpivid_mem_priv *priv; |
|
unsigned long pages; |
|
unsigned long len; |
|
|
|
priv = file->private_data; |
|
pages = priv->regs_phys >> PAGE_SHIFT; |
|
/* |
|
* The address decode is far larger than the actual number of registers. |
|
* Just map the whole lot in. |
|
*/ |
|
len = min(vma->vm_end - vma->vm_start, priv->mem_window_len); |
|
vma->vm_page_prot = phys_mem_access_prot(file, pages, len, |
|
vma->vm_page_prot); |
|
vma->vm_ops = &rpivid_mem_vm_ops; |
|
if (remap_pfn_range(vma, vma->vm_start, |
|
pages, len, |
|
vma->vm_page_prot)) { |
|
return -EAGAIN; |
|
} |
|
return 0; |
|
} |
|
|
|
static const struct file_operations |
|
rpivid_mem_fops = { |
|
.owner = THIS_MODULE, |
|
.open = rpivid_mem_open, |
|
.release = rpivid_mem_release, |
|
.mmap = rpivid_mem_mmap, |
|
}; |
|
|
|
static const struct of_device_id rpivid_mem_of_match[]; |
|
static int rpivid_mem_probe(struct platform_device *pdev) |
|
{ |
|
int err; |
|
const struct of_device_id *id; |
|
struct device *dev = &pdev->dev; |
|
struct resource *ioresource; |
|
struct rpivid_mem_priv *priv; |
|
|
|
/* Allocate buffers and instance data */ |
|
|
|
priv = kzalloc(sizeof(struct rpivid_mem_priv), GFP_KERNEL); |
|
|
|
if (!priv) { |
|
err = -ENOMEM; |
|
goto failed_inst_alloc; |
|
} |
|
platform_set_drvdata(pdev, priv); |
|
|
|
priv->dev = dev; |
|
id = of_match_device(rpivid_mem_of_match, dev); |
|
if (!id) |
|
return -EINVAL; |
|
priv->name = id->data; |
|
|
|
ioresource = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
|
if (ioresource) { |
|
priv->regs_phys = ioresource->start; |
|
priv->mem_window_len = (ioresource->end + 1) - ioresource->start; |
|
} else { |
|
dev_err(priv->dev, "failed to get IO resource"); |
|
err = -ENOENT; |
|
goto failed_get_resource; |
|
} |
|
|
|
/* Create character device entries */ |
|
|
|
err = alloc_chrdev_region(&priv->devid, |
|
DEVICE_MINOR, 2, priv->name); |
|
if (err != 0) { |
|
dev_err(priv->dev, "unable to allocate device number"); |
|
goto failed_alloc_chrdev; |
|
} |
|
cdev_init(&priv->rpivid_mem_cdev, &rpivid_mem_fops); |
|
priv->rpivid_mem_cdev.owner = THIS_MODULE; |
|
err = cdev_add(&priv->rpivid_mem_cdev, priv->devid, 2); |
|
if (err != 0) { |
|
dev_err(priv->dev, "unable to register device"); |
|
goto failed_cdev_add; |
|
} |
|
|
|
/* Create sysfs entries */ |
|
|
|
priv->class = class_create(THIS_MODULE, priv->name); |
|
if (IS_ERR(priv->class)) { |
|
err = PTR_ERR(priv->class); |
|
goto failed_class_create; |
|
} |
|
|
|
dev = device_create(priv->class, NULL, priv->devid, NULL, priv->name); |
|
if (IS_ERR(dev)) { |
|
err = PTR_ERR(dev); |
|
goto failed_device_create; |
|
} |
|
|
|
dev_info(priv->dev, "%s initialised: Registers at 0x%08lx length 0x%08lx", |
|
priv->name, priv->regs_phys, priv->mem_window_len); |
|
|
|
return 0; |
|
|
|
failed_device_create: |
|
class_destroy(priv->class); |
|
failed_class_create: |
|
cdev_del(&priv->rpivid_mem_cdev); |
|
failed_cdev_add: |
|
unregister_chrdev_region(priv->devid, 1); |
|
failed_alloc_chrdev: |
|
failed_get_resource: |
|
kfree(priv); |
|
failed_inst_alloc: |
|
dev_err(&pdev->dev, "could not load rpivid_mem"); |
|
return err; |
|
} |
|
|
|
static int rpivid_mem_remove(struct platform_device *pdev) |
|
{ |
|
struct device *dev = &pdev->dev; |
|
struct rpivid_mem_priv *priv = platform_get_drvdata(pdev); |
|
|
|
device_destroy(priv->class, priv->devid); |
|
class_destroy(priv->class); |
|
cdev_del(&priv->rpivid_mem_cdev); |
|
unregister_chrdev_region(priv->devid, 1); |
|
kfree(priv); |
|
|
|
dev_info(dev, "%s driver removed - OK", priv->name); |
|
return 0; |
|
} |
|
|
|
static const struct of_device_id rpivid_mem_of_match[] = { |
|
{ |
|
.compatible = "raspberrypi,rpivid-hevc-decoder", |
|
.data = "rpivid-hevcmem", |
|
}, |
|
{ |
|
.compatible = "raspberrypi,rpivid-h264-decoder", |
|
.data = "rpivid-h264mem", |
|
}, |
|
{ |
|
.compatible = "raspberrypi,rpivid-vp9-decoder", |
|
.data = "rpivid-vp9mem", |
|
}, |
|
/* The "intc" is included as this block of hardware contains the |
|
* "frame done" status flags. |
|
*/ |
|
{ |
|
.compatible = "raspberrypi,rpivid-local-intc", |
|
.data = "rpivid-intcmem", |
|
}, |
|
{ /* sentinel */ }, |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(of, rpivid_mem_of_match); |
|
|
|
static struct platform_driver rpivid_mem_driver = { |
|
.probe = rpivid_mem_probe, |
|
.remove = rpivid_mem_remove, |
|
.driver = { |
|
.name = DRIVER_NAME, |
|
.owner = THIS_MODULE, |
|
.of_match_table = rpivid_mem_of_match, |
|
}, |
|
}; |
|
|
|
module_platform_driver(rpivid_mem_driver); |
|
|
|
MODULE_ALIAS("platform:rpivid-mem"); |
|
MODULE_LICENSE("GPL"); |
|
MODULE_DESCRIPTION("Driver for accessing RPiVid decoder registers from userspace"); |
|
MODULE_AUTHOR("Jonathan Bell <[email protected]>");
|
|
|