^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * MEN Chameleon Bus.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Author: Andreas Werner <andreas.werner@men.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/dmi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/mcb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "mcb-internal.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) struct priv {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) struct mcb_bus *bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct resource *mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) void __iomem *base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) static int mcb_lpc_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) struct priv *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) if (!priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) priv->mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) if (!priv->mem) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) dev_err(&pdev->dev, "No Memory resource\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) res = devm_request_mem_region(&pdev->dev, priv->mem->start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) resource_size(priv->mem),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) KBUILD_MODNAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) if (!res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) dev_err(&pdev->dev, "Failed to request IO memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) priv->base = devm_ioremap(&pdev->dev, priv->mem->start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) resource_size(priv->mem));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (!priv->base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) dev_err(&pdev->dev, "Cannot ioremap\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) platform_set_drvdata(pdev, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) priv->bus = mcb_alloc_bus(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (IS_ERR(priv->bus))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) return PTR_ERR(priv->bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) ret = chameleon_parse_cells(priv->bus, priv->mem->start, priv->base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) mcb_release_bus(priv->bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) dev_dbg(&pdev->dev, "Found %d cells\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) mcb_bus_add_devices(priv->bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static int mcb_lpc_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct priv *priv = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) mcb_release_bus(priv->bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static struct platform_device *mcb_lpc_pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) static int mcb_lpc_create_platform_device(const struct dmi_system_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) struct resource *res = id->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) mcb_lpc_pdev = platform_device_alloc("mcb-lpc", -1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (!mcb_lpc_pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) ret = platform_device_add_resources(mcb_lpc_pdev, res, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) goto out_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) ret = platform_device_add(mcb_lpc_pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) goto out_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) out_put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) platform_device_put(mcb_lpc_pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static struct resource sc24_fpga_resource = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) .start = 0xe000e000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) .end = 0xe000e000 + CHAM_HEADER_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) .flags = IORESOURCE_MEM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) static struct resource sc31_fpga_resource = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) .start = 0xf000e000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) .end = 0xf000e000 + CHAM_HEADER_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) .flags = IORESOURCE_MEM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) static struct platform_driver mcb_lpc_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) .name = "mcb-lpc",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) .probe = mcb_lpc_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) .remove = mcb_lpc_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) static const struct dmi_system_id mcb_lpc_dmi_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) .ident = "SC24",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) .matches = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) DMI_MATCH(DMI_SYS_VENDOR, "MEN"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) DMI_MATCH(DMI_PRODUCT_VERSION, "14SC24"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) .driver_data = (void *)&sc24_fpga_resource,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) .callback = mcb_lpc_create_platform_device,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) .ident = "SC31",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) .matches = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) DMI_MATCH(DMI_SYS_VENDOR, "MEN"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) DMI_MATCH(DMI_PRODUCT_VERSION, "14SC31"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) .driver_data = (void *)&sc31_fpga_resource,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) .callback = mcb_lpc_create_platform_device,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) MODULE_DEVICE_TABLE(dmi, mcb_lpc_dmi_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static int __init mcb_lpc_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (!dmi_check_system(mcb_lpc_dmi_table))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) return platform_driver_register(&mcb_lpc_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) static void __exit mcb_lpc_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) platform_device_unregister(mcb_lpc_pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) platform_driver_unregister(&mcb_lpc_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) module_init(mcb_lpc_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) module_exit(mcb_lpc_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) MODULE_AUTHOR("Andreas Werner <andreas.werner@men.de>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) MODULE_DESCRIPTION("MCB over LPC support");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) MODULE_IMPORT_NS(MCB);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags