staging/vc04_services: Use correct cache line size
Use the compatible string in the DTB to select the correct cache line size for the SoC - 32 for BCM2835, and 64 for BCM2836 and BCM2837. Signed-off-by: Phil Elwell <phil@raspberrypi.org> Tested-by: Stefan Wahren <stefan.wahren@i2se.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
a779df303b
commit
c683db8860
|
@ -109,7 +109,8 @@ free_pagelist(struct vchiq_pagelist_info *pagelistinfo,
|
|||
int vchiq_platform_init(struct platform_device *pdev, VCHIQ_STATE_T *state)
|
||||
{
|
||||
struct device *dev = &pdev->dev;
|
||||
struct rpi_firmware *fw = platform_get_drvdata(pdev);
|
||||
struct vchiq_drvdata *drvdata = platform_get_drvdata(pdev);
|
||||
struct rpi_firmware *fw = drvdata->fw;
|
||||
VCHIQ_SLOT_ZERO_T *vchiq_slot_zero;
|
||||
struct resource *res;
|
||||
void *slot_mem;
|
||||
|
@ -127,6 +128,7 @@ int vchiq_platform_init(struct platform_device *pdev, VCHIQ_STATE_T *state)
|
|||
if (err < 0)
|
||||
return err;
|
||||
|
||||
g_cache_line_size = drvdata->cache_line_size;
|
||||
g_fragments_size = 2 * g_cache_line_size;
|
||||
|
||||
/* Allocate space for the channels in coherent memory */
|
||||
|
|
|
@ -170,6 +170,14 @@ static struct device *vchiq_dev;
|
|||
static DEFINE_SPINLOCK(msg_queue_spinlock);
|
||||
static struct platform_device *bcm2835_camera;
|
||||
|
||||
static struct vchiq_drvdata bcm2835_drvdata = {
|
||||
.cache_line_size = 32,
|
||||
};
|
||||
|
||||
static struct vchiq_drvdata bcm2836_drvdata = {
|
||||
.cache_line_size = 64,
|
||||
};
|
||||
|
||||
static const char *const ioctl_names[] = {
|
||||
"CONNECT",
|
||||
"SHUTDOWN",
|
||||
|
@ -3573,12 +3581,25 @@ void vchiq_platform_conn_state_changed(VCHIQ_STATE_T *state,
|
|||
}
|
||||
}
|
||||
|
||||
static const struct of_device_id vchiq_of_match[] = {
|
||||
{ .compatible = "brcm,bcm2835-vchiq", .data = &bcm2835_drvdata },
|
||||
{ .compatible = "brcm,bcm2836-vchiq", .data = &bcm2836_drvdata },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, vchiq_of_match);
|
||||
|
||||
static int vchiq_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct device_node *fw_node;
|
||||
struct rpi_firmware *fw;
|
||||
const struct of_device_id *of_id;
|
||||
struct vchiq_drvdata *drvdata;
|
||||
int err;
|
||||
|
||||
of_id = of_match_node(vchiq_of_match, pdev->dev.of_node);
|
||||
drvdata = (struct vchiq_drvdata *)of_id->data;
|
||||
if (!drvdata)
|
||||
return -EINVAL;
|
||||
|
||||
fw_node = of_find_compatible_node(NULL, NULL,
|
||||
"raspberrypi,bcm2835-firmware");
|
||||
if (!fw_node) {
|
||||
|
@ -3586,12 +3607,12 @@ static int vchiq_probe(struct platform_device *pdev)
|
|||
return -ENOENT;
|
||||
}
|
||||
|
||||
fw = rpi_firmware_get(fw_node);
|
||||
drvdata->fw = rpi_firmware_get(fw_node);
|
||||
of_node_put(fw_node);
|
||||
if (!fw)
|
||||
if (!drvdata->fw)
|
||||
return -EPROBE_DEFER;
|
||||
|
||||
platform_set_drvdata(pdev, fw);
|
||||
platform_set_drvdata(pdev, drvdata);
|
||||
|
||||
err = vchiq_platform_init(pdev, &g_state);
|
||||
if (err != 0)
|
||||
|
@ -3661,12 +3682,6 @@ static int vchiq_remove(struct platform_device *pdev)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id vchiq_of_match[] = {
|
||||
{ .compatible = "brcm,bcm2835-vchiq", },
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, vchiq_of_match);
|
||||
|
||||
static struct platform_driver vchiq_driver = {
|
||||
.driver = {
|
||||
.name = "bcm2835_vchiq",
|
||||
|
|
|
@ -123,6 +123,11 @@ typedef struct vchiq_arm_state_struct {
|
|||
|
||||
} VCHIQ_ARM_STATE_T;
|
||||
|
||||
struct vchiq_drvdata {
|
||||
const unsigned int cache_line_size;
|
||||
struct rpi_firmware *fw;
|
||||
};
|
||||
|
||||
extern int vchiq_arm_log_level;
|
||||
extern int vchiq_susp_log_level;
|
||||
|
||||
|
|
Loading…
Reference in New Issue