openwrt/target/linux/brcm2708/patches-3.3/0005-bcm2708-vchiq-driver.p...

16384 lines
487 KiB
Diff

From a2e42fbc97cde9e851f5b036f46b8f34a5be6eb9 Mon Sep 17 00:00:00 2001
From: popcornmix <popcornmix@gmail.com>
Date: Tue, 17 Jan 2012 19:22:19 +0000
Subject: [PATCH 5/7] bcm2708 vchiq driver
Signed-off-by: popcornmix <popcornmix@gmail.com>
---
drivers/misc/Kconfig | 1 +
drivers/misc/Makefile | 1 +
drivers/misc/vc04_services/Kconfig | 7 +
drivers/misc/vc04_services/Makefile | 19 +
.../misc/vc04_services/interface/vchi/vchi_mh.h | 19 +
.../misc/vc04_services/interface/vchiq_arm/vchiq.h | 27 +
.../vc04_services/interface/vchiq_arm/vchiq_2835.h | 27 +
.../interface/vchiq_arm/vchiq_2835_arm.c | 487 ++++
.../vc04_services/interface/vchiq_arm/vchiq_arm.c | 1293 ++++++++++
.../vc04_services/interface/vchiq_arm/vchiq_arm.h | 38 +
.../vc04_services/interface/vchiq_arm/vchiq_cfg.h | 43 +
.../interface/vchiq_arm/vchiq_connected.c | 101 +
.../interface/vchiq_arm/vchiq_connected.h | 32 +
.../vc04_services/interface/vchiq_arm/vchiq_core.c | 2604 ++++++++++++++++++++
.../vc04_services/interface/vchiq_arm/vchiq_core.h | 480 ++++
.../vc04_services/interface/vchiq_arm/vchiq_if.h | 148 ++
.../interface/vchiq_arm/vchiq_ioctl.h | 105 +
.../interface/vchiq_arm/vchiq_kern_lib.c | 297 +++
.../vc04_services/interface/vchiq_arm/vchiq_lib.c | 1518 ++++++++++++
.../interface/vchiq_arm/vchiq_memdrv.h | 45 +
.../interface/vchiq_arm/vchiq_pagelist.h | 43 +
.../vc04_services/interface/vchiq_arm/vchiq_shim.c | 970 ++++++++
.../vc04_services/interface/vchiq_arm/vchiq_util.c | 97 +
.../vc04_services/interface/vchiq_arm/vchiq_util.h | 47 +
.../interface/vcos/generic/vcos_cmd.c | 681 +++++
.../interface/vcos/generic/vcos_common.h | 76 +
.../vcos/generic/vcos_generic_blockpool.h | 260 ++
.../vcos/generic/vcos_generic_event_flags.c | 297 +++
.../vcos/generic/vcos_generic_event_flags.h | 104 +
.../vcos/generic/vcos_generic_named_sem.h | 81 +
.../vcos/generic/vcos_generic_quickslow_mutex.h | 75 +
.../vcos/generic/vcos_generic_reentrant_mtx.h | 75 +
.../interface/vcos/generic/vcos_generic_tls.h | 144 ++
.../vcos/generic/vcos_joinable_thread_from_plain.h | 202 ++
.../interface/vcos/generic/vcos_latch_from_sem.h | 48 +
.../interface/vcos/generic/vcos_logcat.c | 549 +++++
.../interface/vcos/generic/vcos_mem_from_malloc.c | 73 +
.../interface/vcos/generic/vcos_mem_from_malloc.h | 54 +
.../vcos/generic/vcos_mutexes_are_reentrant.h | 68 +
.../interface/vcos/generic/vcos_thread_reaper.h | 35 +
.../interface/vcos/linuxkernel/stdint.h | 17 +
.../interface/vcos/linuxkernel/vcos_linuxkernel.c | 616 +++++
.../vcos/linuxkernel/vcos_linuxkernel_cfg.c | 332 +++
.../vcos/linuxkernel/vcos_linuxkernel_misc.c | 113 +
.../interface/vcos/linuxkernel/vcos_mod_init.c | 64 +
.../interface/vcos/linuxkernel/vcos_platform.h | 496 ++++
.../vcos/linuxkernel/vcos_platform_types.h | 47 +
.../interface/vcos/linuxkernel/vcos_thread_map.c | 129 +
.../interface/vcos/linuxkernel/vcos_thread_map.h | 39 +
drivers/misc/vc04_services/interface/vcos/vcos.h | 201 ++
.../vc04_services/interface/vcos/vcos_assert.h | 269 ++
.../interface/vcos/vcos_atomic_flags.h | 72 +
.../vc04_services/interface/vcos/vcos_build_info.h | 5 +
.../misc/vc04_services/interface/vcos/vcos_cfg.h | 113 +
.../misc/vc04_services/interface/vcos/vcos_cmd.h | 98 +
.../misc/vc04_services/interface/vcos/vcos_ctype.h | 29 +
.../misc/vc04_services/interface/vcos/vcos_dlfcn.h | 69 +
.../misc/vc04_services/interface/vcos/vcos_event.h | 97 +
.../interface/vcos/vcos_event_flags.h | 98 +
.../misc/vc04_services/interface/vcos/vcos_init.h | 43 +
.../vc04_services/interface/vcos/vcos_logging.h | 279 +++
.../interface/vcos/vcos_lowlevel_thread.h | 107 +
.../misc/vc04_services/interface/vcos/vcos_mem.h | 81 +
.../vc04_services/interface/vcos/vcos_msgqueue.h | 157 ++
.../misc/vc04_services/interface/vcos/vcos_mutex.h | 92 +
.../misc/vc04_services/interface/vcos/vcos_once.h | 42 +
.../vc04_services/interface/vcos/vcos_semaphore.h | 115 +
.../vc04_services/interface/vcos/vcos_stdbool.h | 17 +
.../vc04_services/interface/vcos/vcos_stdint.h | 193 ++
.../vc04_services/interface/vcos/vcos_string.h | 73 +
.../vc04_services/interface/vcos/vcos_thread.h | 259 ++
.../interface/vcos/vcos_thread_attr.h | 73 +
.../misc/vc04_services/interface/vcos/vcos_timer.h | 95 +
.../misc/vc04_services/interface/vcos/vcos_types.h | 197 ++
74 files changed, 15998 insertions(+), 0 deletions(-)
create mode 100644 drivers/misc/vc04_services/Kconfig
create mode 100644 drivers/misc/vc04_services/Makefile
create mode 100644 drivers/misc/vc04_services/interface/vchi/vchi_mh.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_2835.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_2835_arm.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_arm.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_arm.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_cfg.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_connected.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_connected.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_core.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_core.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_if.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_ioctl.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_kern_lib.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_lib.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_memdrv.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_pagelist.h
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_shim.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_util.c
create mode 100644 drivers/misc/vc04_services/interface/vchiq_arm/vchiq_util.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_cmd.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_common.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_blockpool.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_event_flags.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_event_flags.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_named_sem.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_quickslow_mutex.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_reentrant_mtx.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_tls.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_joinable_thread_from_plain.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_latch_from_sem.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_logcat.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_mem_from_malloc.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_mem_from_malloc.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_mutexes_are_reentrant.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/generic/vcos_thread_reaper.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/stdint.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel_cfg.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel_misc.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_mod_init.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_platform.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_platform_types.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_thread_map.c
create mode 100644 drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_thread_map.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_assert.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_atomic_flags.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_build_info.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_cfg.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_cmd.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_ctype.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_dlfcn.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_event.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_event_flags.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_init.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_logging.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_lowlevel_thread.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_mem.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_msgqueue.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_mutex.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_once.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_semaphore.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_stdbool.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_stdint.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_string.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_thread.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_thread_attr.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_timer.h
create mode 100644 drivers/misc/vc04_services/interface/vcos/vcos_types.h
--- a/drivers/misc/Kconfig
+++ b/drivers/misc/Kconfig
@@ -506,4 +506,5 @@ source "drivers/misc/ti-st/Kconfig"
source "drivers/misc/lis3lv02d/Kconfig"
source "drivers/misc/carma/Kconfig"
source "drivers/misc/altera-stapl/Kconfig"
+source "drivers/misc/vc04_services/Kconfig"
endmenu
--- a/drivers/misc/Makefile
+++ b/drivers/misc/Makefile
@@ -49,3 +49,5 @@ obj-y += carma/
obj-$(CONFIG_USB_SWITCH_FSA9480) += fsa9480.o
obj-$(CONFIG_ALTERA_STAPL) +=altera-stapl/
obj-$(CONFIG_MAX8997_MUIC) += max8997-muic.o
+obj-y += vc04_services/
+
--- /dev/null
+++ b/drivers/misc/vc04_services/Kconfig
@@ -0,0 +1,7 @@
+config BCM2708_VCHIQ
+ tristate "Videocore VCHIQ"
+ depends on MACH_BCM2708
+ default y
+ help
+ Helper for communication for VideoCore.
+
--- /dev/null
+++ b/drivers/misc/vc04_services/Makefile
@@ -0,0 +1,19 @@
+obj-$(CONFIG_BCM2708_VCHIQ) += vchiq.o
+
+vchiq-objs := \
+ interface/vchiq_arm/vchiq_core.o \
+ interface/vchiq_arm/vchiq_arm.o \
+ interface/vchiq_arm/vchiq_kern_lib.o \
+ interface/vchiq_arm/vchiq_2835_arm.o \
+ interface/vcos/linuxkernel/vcos_linuxkernel.o \
+ interface/vcos/linuxkernel/vcos_thread_map.o \
+ interface/vcos/linuxkernel/vcos_linuxkernel_cfg.o \
+ interface/vcos/generic/vcos_generic_event_flags.o \
+ interface/vcos/generic/vcos_logcat.o \
+ interface/vcos/generic/vcos_mem_from_malloc.o \
+ interface/vcos/generic/vcos_cmd.o
+
+EXTRA_CFLAGS += -DVCOS_VERIFY_BKPTS=1 -Idrivers/misc/vc04_services -Idrivers/misc/vc04_services/interface/vcos/linuxkernel
+
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchi/vchi_mh.h
@@ -0,0 +1,19 @@
+/*=============================================================================
+Copyright (c) 2010 Broadcom Europe Limited. All rights reserved.
+
+Project : vchi
+Module : vchi
+
+FILE DESCRIPTION:
+Definitions for memory handle types.
+=============================================================================*/
+
+#ifndef VCHI_MH_H_
+#define VCHI_MH_H_
+
+#include <interface/vcos/vcos.h>
+
+typedef int32_t VCHI_MEM_HANDLE_T;
+#define VCHI_MEM_HANDLE_INVALID 0
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq.h
@@ -0,0 +1,27 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_VCHIQ_H
+#define VCHIQ_VCHIQ_H
+
+#include "vchiq_if.h"
+#include "vchiq_util.h"
+#include "interface/vcos/vcos.h"
+
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_2835.h
@@ -0,0 +1,27 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_2835_H
+#define VCHIQ_2835_H
+
+#include "vchiq_pagelist.h"
+
+#define VCHIQ_PLATFORM_FRAGMENTS_OFFSET_IDX 0
+#define VCHIQ_PLATFORM_FRAGMENTS_COUNT_IDX 1
+
+#endif /* VCHIQ_2835_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_2835_arm.c
@@ -0,0 +1,487 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include <linux/kernel.h>
+#include <linux/types.h>
+#include <linux/errno.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/pagemap.h>
+#include <linux/dma-mapping.h>
+#include <linux/version.h>
+#include <asm/pgtable.h>
+#include <asm/io.h>
+#include <asm/uaccess.h>
+
+#include <mach/irqs.h>
+
+#include <mach/platform.h>
+#include <mach/vcio.h>
+
+#define TOTAL_SLOTS (VCHIQ_SLOT_ZERO_SLOTS + 2 * 32)
+
+#define VCHIQ_DOORBELL_IRQ IRQ_ARM_DOORBELL_0
+#define VCHIQ_ARM_ADDRESS(x) __virt_to_bus(x)
+
+#include "vchiq_arm.h"
+#include "vchiq_2835.h"
+
+#define MAX_FRAGMENTS (VCHIQ_NUM_CURRENT_BULKS * 2)
+
+#define VCOS_LOG_CATEGORY (&vchiq_arm_log_category)
+
+static char *g_slot_mem;
+static int g_slot_mem_size;
+dma_addr_t g_slot_phys;
+static FRAGMENTS_T *g_fragments_base;
+static FRAGMENTS_T *g_free_fragments;
+struct semaphore g_free_fragments_sema;
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,36)
+static DEFINE_SEMAPHORE(g_free_fragments_mutex);
+#else
+static DECLARE_MUTEX(g_free_fragments_mutex);
+#endif
+
+static irqreturn_t
+vchiq_doorbell_irq(int irq, void *dev_id);
+
+static int
+create_pagelist(char __user *buf, size_t count, unsigned short type,
+ struct task_struct *task, PAGELIST_T ** ppagelist);
+
+static void
+free_pagelist(PAGELIST_T *pagelist, int actual);
+
+int __init
+vchiq_platform_vcos_init(void)
+{
+ return (vcos_init() == VCOS_SUCCESS) ? 0 : -EINVAL;
+}
+
+int __init
+vchiq_platform_init(VCHIQ_STATE_T *state)
+{
+ VCHIQ_SLOT_ZERO_T *vchiq_slot_zero;
+ int frag_mem_size;
+ int err;
+ int i;
+
+ /* Allocate space for the channels in coherent memory */
+ g_slot_mem_size = PAGE_ALIGN(TOTAL_SLOTS * VCHIQ_SLOT_SIZE);
+ frag_mem_size = PAGE_ALIGN(sizeof(FRAGMENTS_T) * MAX_FRAGMENTS);
+
+ g_slot_mem = dma_alloc_coherent(NULL, g_slot_mem_size + frag_mem_size,
+ &g_slot_phys, GFP_ATOMIC);
+
+ if (!g_slot_mem) {
+ vcos_log_error("Unable to allocate channel memory");
+ err = -ENOMEM;
+ goto failed_alloc;
+ }
+
+ vcos_assert(((int)g_slot_mem & (PAGE_SIZE - 1)) == 0);
+
+ vchiq_slot_zero = vchiq_init_slots(g_slot_mem, g_slot_mem_size);
+ if (!vchiq_slot_zero)
+ {
+ err = -EINVAL;
+ goto failed_init_slots;
+ }
+
+ vchiq_slot_zero->platform_data[VCHIQ_PLATFORM_FRAGMENTS_OFFSET_IDX] = (int)g_slot_phys + g_slot_mem_size;
+ vchiq_slot_zero->platform_data[VCHIQ_PLATFORM_FRAGMENTS_COUNT_IDX] = MAX_FRAGMENTS;
+
+ g_fragments_base = (FRAGMENTS_T *)(g_slot_mem + g_slot_mem_size);
+ g_slot_mem_size += frag_mem_size;
+
+ g_free_fragments = g_fragments_base;
+ for (i = 0; i < (MAX_FRAGMENTS - 1); i++) {
+ *(FRAGMENTS_T **) & g_fragments_base[i] =
+ &g_fragments_base[i + 1];
+ }
+ *(FRAGMENTS_T **) & g_fragments_base[i] = NULL;
+ sema_init(&g_free_fragments_sema, MAX_FRAGMENTS);
+
+ if (vchiq_init_state(state, vchiq_slot_zero, 0/*slave*/) !=
+ VCHIQ_SUCCESS)
+ {
+ err = -EINVAL;
+ goto failed_vchiq_init;
+ }
+
+ err = request_irq(VCHIQ_DOORBELL_IRQ, vchiq_doorbell_irq,
+ IRQF_IRQPOLL, "VCHIQ doorbell",
+ state);
+ if (err < 0)
+ {
+ printk( KERN_ERR "%s: failed to register irq=%d err=%d\n", __func__,
+ VCHIQ_DOORBELL_IRQ, err );
+ goto failed_request_irq;
+ }
+
+ /* Send the base address of the slots to VideoCore */
+
+ dsb(); /* Ensure all writes have completed */
+
+ bcm_mailbox_write(MBOX_CHAN_VCHIQ, (unsigned int)g_slot_phys);
+
+ vcos_log_info("vchiq_init - done (slots %x, phys %x)",
+ (unsigned int)vchiq_slot_zero, g_slot_phys);
+
+ return 0;
+
+failed_request_irq:
+failed_vchiq_init:
+failed_init_slots:
+ dma_free_coherent(NULL, g_slot_mem_size, g_slot_mem, g_slot_phys);
+
+failed_alloc:
+ return err;
+}
+
+void __exit
+vchiq_platform_exit(VCHIQ_STATE_T *state)
+{
+ free_irq(VCHIQ_DOORBELL_IRQ, state);
+ dma_free_coherent(NULL, g_slot_mem_size,
+ g_slot_mem, g_slot_phys);
+}
+
+void
+remote_event_signal(REMOTE_EVENT_T *event)
+{
+ event->fired = 1;
+
+ /* The test on the next line also ensures the write on the previous line
+ has completed */
+
+ if (event->armed) {
+ /* trigger vc interrupt */
+ dsb(); /* data barrier operation */
+
+ writel(0, __io_address(ARM_0_BELL2));
+ }
+}
+
+int
+vchiq_copy_from_user(void *dst, const void *src, int size)
+{
+ return copy_from_user(dst, src, size);
+}
+
+VCHIQ_STATUS_T
+vchiq_prepare_bulk_data(VCHIQ_BULK_T *bulk, VCHI_MEM_HANDLE_T memhandle,
+ void *offset, int size, int dir)
+{
+ PAGELIST_T *pagelist;
+ int ret;
+
+ vcos_assert(memhandle == VCHI_MEM_HANDLE_INVALID);
+
+ ret = create_pagelist((char __user *)offset, size,
+ (dir == VCHIQ_BULK_RECEIVE)
+ ? PAGELIST_READ
+ : PAGELIST_WRITE,
+ current,
+ &pagelist);
+ if (ret != 0)
+ return VCHIQ_ERROR;
+
+ bulk->handle = memhandle;
+ bulk->data = VCHIQ_ARM_ADDRESS(pagelist);
+
+ /* Store the pagelist address in remote_data, which isn't used by the
+ slave. */
+ bulk->remote_data = pagelist;
+
+ return VCHIQ_SUCCESS;
+}
+
+void
+vchiq_complete_bulk(VCHIQ_BULK_T *bulk)
+{
+ free_pagelist((PAGELIST_T *)bulk->remote_data, bulk->actual);
+}
+
+void
+vchiq_transfer_bulk(VCHIQ_BULK_T *bulk)
+{
+ /*
+ * This should only be called on the master (VideoCore) side, but
+ * provide an implementation to avoid the need for ifdefery.
+ */
+ vcos_assert(!"This code should not be called by the ARM on BCM2835");
+}
+
+void
+vchiq_dump_platform_state(void *dump_context)
+{
+ char buf[80];
+ int len;
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Platform: 2835 (VC master)");
+ vchiq_dump(dump_context, buf, len + 1);
+}
+
+void
+vchiq_platform_paused(VCHIQ_STATE_T *state)
+{
+ vcos_unused(state);
+ vcos_assert_msg(0, "Suspend/resume not supported");
+}
+
+void
+vchiq_platform_resumed(VCHIQ_STATE_T *state)
+{
+ vcos_unused(state);
+ vcos_assert_msg(0, "Suspend/resume not supported");
+}
+
+VCHIQ_STATUS_T
+vchiq_use_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ if (!service)
+ return VCHIQ_ERROR;
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_release_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ if (!service)
+ return VCHIQ_ERROR;
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_check_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ if (!service)
+ return VCHIQ_ERROR;
+ return VCHIQ_SUCCESS;
+}
+
+/*
+ * Local functions
+ */
+
+static irqreturn_t
+vchiq_doorbell_irq(int irq, void *dev_id)
+{
+ VCHIQ_STATE_T *state = dev_id;
+ irqreturn_t ret = IRQ_NONE;
+ unsigned int status;
+
+ /* Read (and clear) the doorbell */
+ status = readl(__io_address(ARM_0_BELL0));
+
+ if (status & 0x4) { /* Was the doorbell rung? */
+ remote_event_pollall(state);
+ ret = IRQ_HANDLED;
+ }
+
+ return ret;
+}
+
+/* There is a potential problem with partial cache lines (pages?)
+ at the ends of the block when reading. If the CPU accessed anything in
+ the same line (page?) then it may have pulled old data into the cache,
+ obscuring the new data underneath. We can solve this by transferring the
+ partial cache lines separately, and allowing the ARM to copy into the
+ cached area.
+
+ N.B. This implementation plays slightly fast and loose with the Linux
+ driver programming rules, e.g. its use of __virt_to_bus instead of
+ dma_map_single, but it isn't a multi-platform driver and it benefits
+ from increased speed as a result.
+ */
+
+static int
+create_pagelist(char __user *buf, size_t count, unsigned short type,
+ struct task_struct *task, PAGELIST_T ** ppagelist)
+{
+ PAGELIST_T *pagelist;
+ struct page **pages;
+ struct page *page;
+ unsigned long *addrs;
+ unsigned int num_pages, offset, i;
+ char *addr, *base_addr, *next_addr;
+ int run, addridx, actual_pages;
+
+ offset = (unsigned int)buf & (PAGE_SIZE - 1);
+ num_pages = (count + offset + PAGE_SIZE - 1) / PAGE_SIZE;
+
+ *ppagelist = NULL;
+
+ /* Allocate enough storage to hold the page pointers and the page list */
+ pagelist = (PAGELIST_T *) kmalloc(sizeof(PAGELIST_T) +
+ (num_pages * sizeof(unsigned long)) +
+ (num_pages * sizeof(pages[0])),
+ GFP_KERNEL);
+
+ vcos_log_trace("create_pagelist - %x", (unsigned int)pagelist);
+ if (!pagelist)
+ return -ENOMEM;
+
+ addrs = pagelist->addrs;
+ pages = (struct page **)(addrs + num_pages);
+
+ down_read(&task->mm->mmap_sem);
+ actual_pages = get_user_pages(task, task->mm,
+ (unsigned long)buf & ~(PAGE_SIZE - 1), num_pages,
+ (type == PAGELIST_READ) /*Write */ , 0 /*Force */ ,
+ pages, NULL /*vmas */ );
+ up_read(&task->mm->mmap_sem);
+
+ if (actual_pages != num_pages)
+ {
+ for (i = 0; i < actual_pages; i++) {
+ page_cache_release(pages[i]);
+ }
+ kfree(pagelist);
+ return -EINVAL;
+ }
+
+ pagelist->length = count;
+ pagelist->type = type;
+ pagelist->offset = offset;
+
+ /* Group the pages into runs of contiguous pages */
+
+ base_addr = VCHIQ_ARM_ADDRESS(page_address(pages[0]));
+ next_addr = base_addr + PAGE_SIZE;
+ addridx = 0;
+ run = 0;
+
+ for (i = 1; i < num_pages; i++) {
+ addr = VCHIQ_ARM_ADDRESS(page_address(pages[i]));
+ if ((addr == next_addr) && (run < (PAGE_SIZE - 1))) {
+ next_addr += PAGE_SIZE;
+ run++;
+ } else {
+ addrs[addridx] = (unsigned long)base_addr + run;
+ addridx++;
+ base_addr = addr;
+ next_addr = addr + PAGE_SIZE;
+ run = 0;
+ }
+ }
+
+ addrs[addridx] = (unsigned long)base_addr + run;
+ addridx++;
+
+ /* Partial cache lines (fragments) require special measures */
+ if ((type == PAGELIST_READ) &&
+ ((pagelist->offset & (CACHE_LINE_SIZE - 1)) ||
+ ((pagelist->offset + pagelist->length) & (CACHE_LINE_SIZE - 1)))) {
+ FRAGMENTS_T *fragments;
+
+ if (down_interruptible(&g_free_fragments_sema) != 0) {
+ kfree(pagelist);
+ return -EINTR;
+ }
+
+ vcos_assert(g_free_fragments != NULL);
+
+ down(&g_free_fragments_mutex);
+ fragments = (FRAGMENTS_T *) g_free_fragments;
+ vcos_assert(fragments != NULL);
+ g_free_fragments = *(FRAGMENTS_T **) g_free_fragments;
+ up(&g_free_fragments_mutex);
+ pagelist->type =
+ PAGELIST_READ_WITH_FRAGMENTS + (fragments -
+ g_fragments_base);
+ }
+
+ for (page = virt_to_page(pagelist);
+ page <= virt_to_page(addrs + num_pages - 1); page++) {
+ flush_dcache_page(page);
+ }
+
+ *ppagelist = pagelist;
+
+ return 0;
+}
+
+static void
+free_pagelist(PAGELIST_T *pagelist, int actual)
+{
+ struct page **pages;
+ unsigned int num_pages, i;
+
+ vcos_log_trace("free_pagelist - %x, %d", (unsigned int)pagelist, actual);
+
+ num_pages =
+ (pagelist->length + pagelist->offset + PAGE_SIZE - 1) / PAGE_SIZE;
+
+ pages = (struct page **)(pagelist->addrs + num_pages);
+
+ /* Deal with any partial cache lines (fragments) */
+ if (pagelist->type >= PAGELIST_READ_WITH_FRAGMENTS) {
+ FRAGMENTS_T *fragments =
+ g_fragments_base + (pagelist->type -
+ PAGELIST_READ_WITH_FRAGMENTS);
+ int head_bytes, tail_bytes;
+
+ if (actual >= 0)
+ {
+ if ((head_bytes = (CACHE_LINE_SIZE - pagelist->offset) & (CACHE_LINE_SIZE - 1)) != 0) {
+ if (head_bytes > actual)
+ head_bytes = actual;
+
+ memcpy((char *)page_address(pages[0]) +
+ pagelist->offset, fragments->headbuf,
+ head_bytes);
+ }
+ if ((head_bytes < actual) &&
+ (tail_bytes =
+ (pagelist->offset + actual) & (CACHE_LINE_SIZE -
+ 1)) != 0) {
+ memcpy((char *)page_address(pages[num_pages - 1]) +
+ ((pagelist->offset + actual) & (PAGE_SIZE -
+ 1) & ~(CACHE_LINE_SIZE - 1)),
+ fragments->tailbuf, tail_bytes);
+ }
+ }
+
+ down(&g_free_fragments_mutex);
+ *(FRAGMENTS_T **) fragments = g_free_fragments;
+ g_free_fragments = fragments;
+ up(&g_free_fragments_mutex);
+ up(&g_free_fragments_sema);
+ }
+
+ for (i = 0; i < num_pages; i++) {
+ if (pagelist->type != PAGELIST_WRITE)
+ set_page_dirty(pages[i]);
+ page_cache_release(pages[i]);
+ }
+
+ kfree(pagelist);
+}
+
+VCHIQ_STATUS_T
+vchiq_platform_suspend(VCHIQ_STATE_T *state)
+{
+ vcos_unused(state);
+ return VCHIQ_ERROR;
+}
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_arm.c
@@ -0,0 +1,1293 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/errno.h>
+#include <linux/cdev.h>
+#include <linux/fs.h>
+#include <linux/device.h>
+
+#include "vchiq_core.h"
+#include "vchiq_ioctl.h"
+#include "vchiq_arm.h"
+
+#define DEVICE_NAME "vchiq"
+
+/* Override the default prefix, which would be vchiq_arm (from the filename) */
+#undef MODULE_PARAM_PREFIX
+#define MODULE_PARAM_PREFIX DEVICE_NAME "."
+
+#define VCHIQ_MINOR 0
+
+/* Some per-instance constants */
+#define MAX_COMPLETIONS 16
+#define MAX_SERVICES 64
+#define MAX_ELEMENTS 8
+#define MSG_QUEUE_SIZE 64
+
+#define VCOS_LOG_CATEGORY (&vchiq_arm_log_category)
+
+typedef struct client_service_struct {
+ VCHIQ_SERVICE_T *service;
+ void *userdata;
+ VCHIQ_INSTANCE_T instance;
+ int handle;
+ int is_vchi;
+ volatile int dequeue_pending;
+ volatile int message_available_pos;
+ volatile int msg_insert;
+ volatile int msg_remove;
+ VCOS_EVENT_T insert_event;
+ VCOS_EVENT_T remove_event;
+ VCHIQ_HEADER_T *msg_queue[MSG_QUEUE_SIZE];
+} USER_SERVICE_T;
+
+struct vchiq_instance_struct {
+ VCHIQ_STATE_T *state;
+ VCHIQ_COMPLETION_DATA_T completions[MAX_COMPLETIONS];
+ volatile int completion_insert;
+ volatile int completion_remove;
+ VCOS_EVENT_T insert_event;
+ VCOS_EVENT_T remove_event;
+
+ USER_SERVICE_T services[MAX_SERVICES];
+
+ int connected;
+ int closing;
+ int pid;
+ int mark;
+};
+
+typedef struct dump_context_struct
+{
+ char __user *buf;
+ size_t actual;
+ size_t space;
+ loff_t offset;
+} DUMP_CONTEXT_T;
+
+VCOS_LOG_CAT_T vchiq_arm_log_category;
+
+static struct cdev vchiq_cdev;
+static dev_t vchiq_devid;
+static VCHIQ_STATE_T g_state;
+static struct class *vchiq_class;
+static struct device *vchiq_dev;
+
+static const char *ioctl_names[] =
+{
+ "CONNECT",
+ "SHUTDOWN",
+ "CREATE_SERVICE",
+ "REMOVE_SERVICE",
+ "QUEUE_MESSAGE",
+ "QUEUE_BULK_TRANSMIT",
+ "QUEUE_BULK_RECEIVE",
+ "AWAIT_COMPLETION",
+ "DEQUEUE_MESSAGE",
+ "GET_CLIENT_ID",
+ "GET_CONFIG",
+ "CLOSE_SERVICE",
+ "USE_SERVICE",
+ "RELEASE_SERIVCE"
+};
+
+VCOS_LOG_LEVEL_T vchiq_default_arm_log_level = VCOS_LOG_WARN;
+
+/****************************************************************************
+*
+* find_service_by_handle
+*
+***************************************************************************/
+
+static inline USER_SERVICE_T *find_service_by_handle(
+ VCHIQ_INSTANCE_T instance, int handle )
+{
+ USER_SERVICE_T *user_service;
+
+ if (( handle >= 0 )
+ && ( handle < MAX_SERVICES ))
+ {
+ user_service = &instance->services[ handle ];
+
+ if ( user_service->service != NULL )
+ {
+ return user_service;
+ }
+ }
+
+ return NULL;
+}
+
+/****************************************************************************
+*
+* find_avail_service_handle
+*
+***************************************************************************/
+
+static inline USER_SERVICE_T *find_avail_service_handle(
+ VCHIQ_INSTANCE_T instance)
+{
+ int handle;
+
+ for ( handle = 0; handle < MAX_SERVICES; handle++ )
+ {
+ if ( instance->services[handle].service == NULL )
+ {
+ instance->services[handle].instance = instance;
+ instance->services[handle].handle = handle;
+
+ return &instance->services[handle];
+ }
+ }
+ return NULL;
+}
+
+/****************************************************************************
+*
+* add_completion
+*
+***************************************************************************/
+
+static VCHIQ_STATUS_T
+add_completion(VCHIQ_INSTANCE_T instance, VCHIQ_REASON_T reason,
+ VCHIQ_HEADER_T *header, USER_SERVICE_T *service, void *bulk_userdata)
+{
+ VCHIQ_COMPLETION_DATA_T *completion;
+ DEBUG_INITIALISE(g_state.local)
+
+ while (instance->completion_insert ==
+ (instance->completion_remove + MAX_COMPLETIONS)) {
+ /* Out of space - wait for the client */
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ vcos_log_trace("add_completion - completion queue full");
+ DEBUG_COUNT(COMPLETION_QUEUE_FULL_COUNT);
+ if (vcos_event_wait(&instance->remove_event) != VCOS_SUCCESS) {
+ vcos_log_info("service_callback interrupted");
+ return VCHIQ_RETRY;
+ } else if (instance->closing) {
+ vcos_log_info("service_callback closing");
+ return VCHIQ_ERROR;
+ }
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ }
+
+ completion =
+ &instance->
+ completions[instance->completion_insert & (MAX_COMPLETIONS - 1)];
+
+ completion->header = header;
+ completion->reason = reason;
+ completion->service_userdata = service;
+ completion->bulk_userdata = bulk_userdata;
+
+ /* A write barrier is needed here to ensure that the entire completion
+ record is written out before the insert point. */
+ vcos_wmb(&completion->bulk_userdata);
+
+ if (reason == VCHIQ_MESSAGE_AVAILABLE)
+ service->message_available_pos = instance->completion_insert;
+ instance->completion_insert++;
+
+ vcos_event_signal(&instance->insert_event);
+
+ return VCHIQ_SUCCESS;
+}
+
+/****************************************************************************
+*
+* service_callback
+*
+***************************************************************************/
+
+static VCHIQ_STATUS_T
+service_callback(VCHIQ_REASON_T reason, VCHIQ_HEADER_T *header,
+ VCHIQ_SERVICE_HANDLE_T handle, void *bulk_userdata)
+{
+ /* How do we ensure the callback goes to the right client?
+ The service_user data points to a USER_SERVICE_T record containing the
+ original callback and the user state structure, which contains a circular
+ buffer for completion records.
+ */
+ USER_SERVICE_T *service =
+ (USER_SERVICE_T *) VCHIQ_GET_SERVICE_USERDATA(handle);
+ VCHIQ_INSTANCE_T instance = service->instance;
+ DEBUG_INITIALISE(g_state.local)
+
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ vcos_log_trace
+ ("service_callback - service %lx(%d), reason %d, header %lx, "
+ "instance %lx, bulk_userdata %lx",
+ (unsigned long)service, ((VCHIQ_SERVICE_T *) handle)->localport,
+ reason, (unsigned long)header,
+ (unsigned long)instance, (unsigned long)bulk_userdata);
+
+ if (!instance || instance->closing) {
+ return VCHIQ_SUCCESS;
+ }
+
+ if (header && service->is_vchi)
+ {
+ while (service->msg_insert == (service->msg_remove + MSG_QUEUE_SIZE))
+ {
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ DEBUG_COUNT(MSG_QUEUE_FULL_COUNT);
+ vcos_log_trace("service_callback - msg queue full");
+ /* If there is no MESSAGE_AVAILABLE in the completion queue, add one */
+ if ((service->message_available_pos - instance->completion_remove) < 0)
+ {
+ VCHIQ_STATUS_T status;
+ vcos_log_warn("Inserting extra MESSAGE_AVAILABLE");
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ status = add_completion(instance, reason, NULL, service, bulk_userdata);
+ if (status != VCHIQ_SUCCESS)
+ {
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ return status;
+ }
+ }
+
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ if (vcos_event_wait(&service->remove_event) != VCOS_SUCCESS) {
+ vcos_log_info("service_callback interrupted");
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ return VCHIQ_RETRY;
+ } else if (instance->closing) {
+ vcos_log_info("service_callback closing");
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ return VCHIQ_ERROR;
+ }
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ }
+
+ service->msg_queue[service->msg_insert & (MSG_QUEUE_SIZE - 1)] =
+ header;
+
+ /* A write memory barrier is needed to ensure that the store of header
+ is completed before the insertion point is updated */
+ vcos_wmb(&service->msg_queue[service->msg_insert & (MSG_QUEUE_SIZE - 1)]);
+
+ service->msg_insert++;
+ vcos_event_signal(&service->insert_event);
+
+ /* If there is a thread waiting in DEQUEUE_MESSAGE, or if
+ there is a MESSAGE_AVAILABLE in the completion queue then
+ bypass the completion queue. */
+ if (((service->message_available_pos - instance->completion_remove) >= 0) ||
+ service->dequeue_pending)
+ {
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+ service->dequeue_pending = 0;
+ return VCHIQ_SUCCESS;
+ }
+
+ header = NULL;
+ }
+ DEBUG_TRACE(SERVICE_CALLBACK_LINE);
+
+ return add_completion(instance, reason, header, service, bulk_userdata);
+}
+
+/****************************************************************************
+*
+* vchiq_ioctl
+*
+***************************************************************************/
+
+static long
+vchiq_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
+{
+ VCHIQ_INSTANCE_T instance = file->private_data;
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+ long ret = 0;
+ int i, rc;
+ DEBUG_INITIALISE(g_state.local)
+
+ vcos_log_trace("vchiq_ioctl - instance %x, cmd %s, arg %lx",
+ (unsigned int)instance,
+ ((_IOC_TYPE(cmd) == VCHIQ_IOC_MAGIC) && (_IOC_NR(cmd) <= VCHIQ_IOC_MAX)) ?
+ ioctl_names[_IOC_NR(cmd)] : "<invalid>", arg);
+
+ switch (cmd) {
+ case VCHIQ_IOC_SHUTDOWN:
+ if (!instance->connected)
+ break;
+
+ /* Remove all services */
+ for (i = 0; i < MAX_SERVICES; i++) {
+ USER_SERVICE_T *service = &instance->services[i];
+ if (service->service != NULL) {
+ status = vchiq_remove_service(&service->service->base);
+ if (status != VCHIQ_SUCCESS)
+ break;
+ service->service = NULL;
+ }
+ }
+
+ if (status == VCHIQ_SUCCESS) {
+ /* Wake the completion thread and ask it to exit */
+ instance->closing = 1;
+ vcos_event_signal(&instance->insert_event);
+ }
+
+ break;
+
+ case VCHIQ_IOC_CONNECT:
+ if (instance->connected) {
+ ret = -EINVAL;
+ break;
+ }
+ if ((rc=vcos_mutex_lock(&instance->state->mutex)) != VCOS_SUCCESS) {
+ vcos_log_error("vchiq: connect: could not lock mutex for state %d: %d",
+ instance->state->id, rc);
+ ret = -EINTR;
+ break;
+ }
+ status = vchiq_connect_internal(instance->state, instance);
+ vcos_mutex_unlock(&instance->state->mutex);
+
+ if (status == VCHIQ_SUCCESS)
+ instance->connected = 1;
+ else
+ vcos_log_error("vchiq: could not connect: %d", status);
+ break;
+
+ case VCHIQ_IOC_CREATE_SERVICE:
+ {
+ VCHIQ_CREATE_SERVICE_T args;
+ VCHIQ_SERVICE_T *service = NULL;
+ USER_SERVICE_T *user_service = NULL;
+ void *userdata;
+ int srvstate;
+
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+
+ for (i = 0; i < MAX_SERVICES; i++) {
+ if (instance->services[i].service == NULL) {
+ user_service = &instance->services[i];
+ break;
+ }
+ }
+
+ if (!user_service) {
+ ret = -EMFILE;
+ break;
+ }
+
+ if (args.is_open) {
+ if (instance->connected)
+ srvstate = VCHIQ_SRVSTATE_OPENING;
+ else {
+ ret = -ENOTCONN;
+ break;
+ }
+ } else {
+ srvstate =
+ instance->connected ?
+ VCHIQ_SRVSTATE_LISTENING :
+ VCHIQ_SRVSTATE_HIDDEN;
+ }
+
+ vcos_mutex_lock(&instance->state->mutex);
+
+ userdata = args.params.userdata;
+ args.params.callback = service_callback;
+ args.params.userdata = user_service;
+ service =
+ vchiq_add_service_internal(instance->state,
+ &args.params, srvstate,
+ instance);
+
+ vcos_mutex_unlock(&instance->state->mutex);
+
+ if (service != NULL) {
+ user_service->service = service;
+ user_service->userdata = userdata;
+ user_service->instance = instance;
+ user_service->handle = i;
+ user_service->is_vchi = args.is_vchi;
+ user_service->dequeue_pending = 0;
+ user_service->message_available_pos = instance->completion_remove - 1;
+ user_service->msg_insert = 0;
+ user_service->msg_remove = 0;
+ vcos_event_create(&user_service->insert_event, "insert_event");
+ vcos_event_create(&user_service->remove_event, "remove_event");
+
+ if (args.is_open) {
+ status =
+ vchiq_open_service_internal
+ (service, instance->pid);
+ if (status != VCHIQ_SUCCESS) {
+ vchiq_remove_service
+ (&service->base);
+ ret =
+ (status ==
+ VCHIQ_RETRY) ? -EINTR :
+ -EIO;
+ user_service->service = NULL;
+ user_service->instance = NULL;
+ vcos_event_delete(&user_service->insert_event);
+ vcos_event_delete(&user_service->remove_event);
+ break;
+ }
+ }
+
+ if (copy_to_user((void __user *)
+ &(((VCHIQ_CREATE_SERVICE_T __user
+ *) arg)->handle),
+ (const void *)&user_service->
+ handle,
+ sizeof(user_service->
+ handle)) != 0)
+ ret = -EFAULT;
+ } else {
+ ret = -EEXIST;
+ }
+ }
+ break;
+
+ case VCHIQ_IOC_CLOSE_SERVICE:
+ {
+ USER_SERVICE_T *user_service;
+ int handle = (int)arg;
+
+ user_service = find_service_by_handle(instance, handle);
+ if (user_service != NULL)
+ {
+ int is_server = (user_service->service->public_fourcc != VCHIQ_FOURCC_INVALID);
+
+ status =
+ vchiq_close_service(&user_service->service->base);
+ if ((status == VCHIQ_SUCCESS) && !is_server)
+ {
+ vcos_event_delete(&user_service->insert_event);
+ vcos_event_delete(&user_service->remove_event);
+ user_service->service = NULL;
+ }
+ } else
+ ret = -EINVAL;
+ }
+ break;
+
+ case VCHIQ_IOC_REMOVE_SERVICE:
+ {
+ USER_SERVICE_T *user_service;
+ int handle = (int)arg;
+
+ user_service = find_service_by_handle(instance, handle);
+ if (user_service != NULL)
+ {
+ status =
+ vchiq_remove_service(&user_service->service->base);
+ if (status == VCHIQ_SUCCESS)
+ {
+ vcos_event_delete(&user_service->insert_event);
+ vcos_event_delete(&user_service->remove_event);
+ user_service->service = NULL;
+ }
+ } else
+ ret = -EINVAL;
+ }
+ break;
+
+ case VCHIQ_IOC_USE_SERVICE:
+ case VCHIQ_IOC_RELEASE_SERVICE:
+ {
+ USER_SERVICE_T *user_service;
+ int handle = (int)arg;
+
+ user_service = find_service_by_handle(instance, handle);
+ if (user_service != NULL)
+ {
+ status = (cmd == VCHIQ_IOC_USE_SERVICE) ? vchiq_use_service(&user_service->service->base) : vchiq_release_service(&user_service->service->base);
+ if (status != VCHIQ_SUCCESS)
+ {
+ ret = -EINVAL; // ???
+ }
+ }
+ }
+ break;
+
+ case VCHIQ_IOC_QUEUE_MESSAGE:
+ {
+ VCHIQ_QUEUE_MESSAGE_T args;
+ USER_SERVICE_T *user_service;
+
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+ user_service = find_service_by_handle(instance, args.handle);
+ if ((user_service != NULL) && (args.count <= MAX_ELEMENTS))
+ {
+ /* Copy elements into kernel space */
+ VCHIQ_ELEMENT_T elements[MAX_ELEMENTS];
+ if (copy_from_user
+ (elements, args.elements,
+ args.count * sizeof(VCHIQ_ELEMENT_T)) == 0)
+ status =
+ vchiq_queue_message
+ (&user_service->service->base,
+ elements, args.count);
+ else
+ ret = -EFAULT;
+ } else {
+ ret = -EINVAL;
+ }
+ }
+ break;
+
+ case VCHIQ_IOC_QUEUE_BULK_TRANSMIT:
+ case VCHIQ_IOC_QUEUE_BULK_RECEIVE:
+ {
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ USER_SERVICE_T *user_service;
+ VCHIQ_BULK_DIR_T dir =
+ (cmd == VCHIQ_IOC_QUEUE_BULK_TRANSMIT) ?
+ VCHIQ_BULK_TRANSMIT : VCHIQ_BULK_RECEIVE;
+
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+ user_service = find_service_by_handle(instance, args.handle);
+ if (user_service != NULL)
+ {
+ status =
+ vchiq_bulk_transfer
+ ((VCHIQ_SERVICE_T *)user_service->service,
+ VCHI_MEM_HANDLE_INVALID,
+ args.data, args.size,
+ args.userdata, args.mode,
+ dir);
+ } else {
+ ret = -EINVAL;
+ }
+ }
+ break;
+
+ case VCHIQ_IOC_AWAIT_COMPLETION:
+ {
+ VCHIQ_AWAIT_COMPLETION_T args;
+
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+ if (!instance->connected) {
+ ret = -ENOTCONN;
+ break;
+ }
+
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+ while ((instance->completion_remove ==
+ instance->completion_insert)
+ && !instance->closing) {
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+ if (vcos_event_wait(&instance->insert_event) !=
+ VCOS_SUCCESS) {
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+ vcos_log_info
+ ("AWAIT_COMPLETION interrupted");
+ ret = -EINTR;
+ break;
+ }
+ }
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+
+ /* A read memory barrier is needed to stop prefetch of a stale
+ completion record */
+ vcos_rmb();
+
+ if (ret == 0) {
+ int msgbufcount = args.msgbufcount;
+ for (ret = 0; ret < args.count; ret++) {
+ VCHIQ_COMPLETION_DATA_T *completion;
+ USER_SERVICE_T *service;
+ VCHIQ_HEADER_T *header;
+ if (instance->completion_remove ==
+ instance->completion_insert)
+ break;
+ completion =
+ &instance->
+ completions
+ [instance->completion_remove &
+ (MAX_COMPLETIONS - 1)];
+
+ service = (USER_SERVICE_T *)completion->service_userdata;
+ completion->service_userdata = service->userdata;
+
+ header = completion->header;
+ if (header)
+ {
+ void __user *msgbuf;
+ int msglen;
+
+ msglen = header->size + sizeof(VCHIQ_HEADER_T);
+ /* This must be a VCHIQ-style service */
+ if (args.msgbufsize < msglen)
+ {
+ vcos_log_error("header %x: msgbufsize %x < msglen %x",
+ (unsigned int)header, args.msgbufsize, msglen);
+ vcos_assert(0);
+ if (ret == 0)
+ ret = -EMSGSIZE;
+ break;
+ }
+ if (msgbufcount <= 0)
+ {
+ /* Stall here for lack of a buffer for the message */
+ break;
+ }
+ /* Get the pointer from user space */
+ msgbufcount--;
+ if (copy_from_user(&msgbuf,
+ (const void __user *)&args.msgbufs[msgbufcount],
+ sizeof(msgbuf)) != 0)
+ {
+ if (ret == 0)
+ ret = -EFAULT;
+ break;
+ }
+
+ /* Copy the message to user space */
+ if (copy_to_user(msgbuf, header, msglen) != 0)
+ {
+ if (ret == 0)
+ ret = -EFAULT;
+ break;
+ }
+
+ /* Now it has been copied, the message can be released. */
+ vchiq_release_message(&service->service->base, header);
+
+ /* The completion must point to the msgbuf */
+ completion->header = msgbuf;
+ }
+
+ if (copy_to_user
+ ((void __user *)((size_t) args.buf +
+ ret *
+ sizeof
+ (VCHIQ_COMPLETION_DATA_T)),
+ completion,
+ sizeof(VCHIQ_COMPLETION_DATA_T)) !=
+ 0) {
+ if (ret == 0)
+ ret = -EFAULT;
+ break;
+ }
+ instance->completion_remove++;
+ }
+
+ if (msgbufcount != args.msgbufcount)
+ {
+ if (copy_to_user((void __user *)
+ &((VCHIQ_AWAIT_COMPLETION_T *)arg)->msgbufcount,
+ &msgbufcount, sizeof(msgbufcount)) != 0)
+ {
+ ret = -EFAULT;
+ break;
+ }
+ }
+ }
+
+ if (ret != 0)
+ vcos_event_signal(&instance->remove_event);
+ DEBUG_TRACE(AWAIT_COMPLETION_LINE);
+ }
+ break;
+
+ case VCHIQ_IOC_DEQUEUE_MESSAGE:
+ {
+ VCHIQ_DEQUEUE_MESSAGE_T args;
+ USER_SERVICE_T *user_service;
+ VCHIQ_HEADER_T *header;
+
+ DEBUG_TRACE(DEQUEUE_MESSAGE_LINE);
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+ user_service = &instance->services[args.handle];
+ if ((args.handle < 0) || (args.handle >= MAX_SERVICES) ||
+ (user_service->service == NULL) ||
+ (user_service->is_vchi == 0)) {
+ ret = -EINVAL;
+ break;
+ }
+ if (user_service->msg_remove == user_service->msg_insert)
+ {
+ if (!args.blocking)
+ {
+ DEBUG_TRACE(DEQUEUE_MESSAGE_LINE);
+ ret = -EWOULDBLOCK;
+ break;
+ }
+ user_service->dequeue_pending = 1;
+ do {
+ DEBUG_TRACE(DEQUEUE_MESSAGE_LINE);
+ if (vcos_event_wait(&user_service->insert_event) !=
+ VCOS_SUCCESS) {
+ vcos_log_info("DEQUEUE_MESSAGE interrupted");
+ ret = -EINTR;
+ break;
+ }
+ }
+ while (user_service->msg_remove == user_service->msg_insert);
+ }
+
+ /* A read memory barrier is needed to stop prefetch of a stale
+ header value */
+ vcos_rmb();
+
+ header = user_service->msg_queue[user_service->msg_remove &
+ (MSG_QUEUE_SIZE - 1)];
+ if (header == NULL)
+ ret = -ENOTCONN;
+ else if (header->size <= args.bufsize)
+ {
+ /* Copy to user space if msgbuf is not NULL */
+ if ((args.buf == NULL) ||
+ (copy_to_user((void __user *)args.buf, header->data,
+ header->size) == 0))
+ {
+ ret = header->size;
+ vchiq_release_message(&user_service->service->base,
+ header);
+ user_service->msg_remove++;
+ vcos_event_signal(&user_service->remove_event);
+ }
+ else
+ ret = -EFAULT;
+ }
+ else
+ {
+ vcos_log_error("header %x: bufsize %x < size %x",
+ (unsigned int)header, args.bufsize, header->size);
+ vcos_assert(0);
+ ret = -EMSGSIZE;
+ }
+ DEBUG_TRACE(DEQUEUE_MESSAGE_LINE);
+ }
+ break;
+
+ case VCHIQ_IOC_GET_CLIENT_ID:
+ {
+ USER_SERVICE_T *user_service;
+ int handle = (int)arg;
+
+ user_service = find_service_by_handle(instance, handle);
+ if (user_service != NULL)
+ ret = vchiq_get_client_id(&user_service->service->base);
+ else
+ ret = 0;
+ }
+ break;
+
+ case VCHIQ_IOC_GET_CONFIG:
+ {
+ VCHIQ_GET_CONFIG_T args;
+ VCHIQ_CONFIG_T config;
+
+ if (copy_from_user
+ (&args, (const void __user *)arg,
+ sizeof(args)) != 0) {
+ ret = -EFAULT;
+ break;
+ }
+ if (args.config_size > sizeof(config))
+ {
+ ret = -EINVAL;
+ break;
+ }
+ status = vchiq_get_config(instance, args.config_size, &config);
+ if (status == VCHIQ_SUCCESS)
+ {
+ if (copy_to_user((void __user *)args.pconfig,
+ &config, args.config_size) != 0)
+ {
+ ret = -EFAULT;
+ break;
+ }
+ }
+ }
+ break;
+
+ case VCHIQ_IOC_SET_SERVICE_OPTION:
+ {
+ VCHIQ_SET_SERVICE_OPTION_T args;
+ USER_SERVICE_T *user_service;
+
+ if (copy_from_user(
+ &args, (const void __user *)arg,
+ sizeof(args)) != 0)
+ {
+ ret = -EFAULT;
+ break;
+ }
+
+ user_service = find_service_by_handle(instance, args.handle);
+ if (user_service != NULL)
+ {
+ status = vchiq_set_service_option(
+ &user_service->service->base,
+ args.option, args.value);
+ }
+ else
+ {
+ ret = -EINVAL;
+ }
+ }
+ break;
+
+ default:
+ ret = -ENOTTY;
+ break;
+ }
+
+ if (ret == 0) {
+ if (status == VCHIQ_ERROR)
+ ret = -EIO;
+ else if (status == VCHIQ_RETRY)
+ ret = -EINTR;
+ }
+
+ if ((ret < 0) && (ret != -EINTR) && (ret != -EWOULDBLOCK))
+ vcos_log_warn(" ioctl instance %lx, cmd %s -> status %d, %ld",
+ (unsigned long)instance,
+ (_IOC_NR(cmd) <= VCHIQ_IOC_MAX) ? ioctl_names[_IOC_NR(cmd)] :
+ "<invalid>", status, ret);
+ else
+ vcos_log_trace(" ioctl instance %lx, cmd %s -> status %d, %ld",
+ (unsigned long)instance,
+ (_IOC_NR(cmd) <= VCHIQ_IOC_MAX) ? ioctl_names[_IOC_NR(cmd)] :
+ "<invalid>", status, ret);
+
+ return ret;
+}
+
+/****************************************************************************
+*
+* vchiq_open
+*
+***************************************************************************/
+
+static int
+vchiq_open(struct inode *inode, struct file *file)
+{
+ int dev = iminor(inode) & 0x0f;
+ vcos_log_info("vchiq_open");
+ switch (dev) {
+ case VCHIQ_MINOR:
+ {
+ VCHIQ_STATE_T *state = vchiq_get_state();
+ VCHIQ_INSTANCE_T instance;
+
+ if (!state)
+ {
+ vcos_log_error( "vchiq has no connection to VideoCore");
+ return -ENOTCONN;
+ }
+
+ instance = kzalloc(sizeof(*instance), GFP_KERNEL);
+ if (!instance)
+ return -ENOMEM;
+
+ instance->state = state;
+ instance->pid = current->tgid;
+ vcos_event_create(&instance->insert_event, DEVICE_NAME);
+ vcos_event_create(&instance->remove_event, DEVICE_NAME);
+
+ file->private_data = instance;
+ }
+ break;
+
+ default:
+ vcos_log_error("Unknown minor device: %d", dev);
+ return -ENXIO;
+ }
+
+ return 0;
+}
+
+/****************************************************************************
+*
+* vchiq_release
+*
+***************************************************************************/
+
+static int
+vchiq_release(struct inode *inode, struct file *file)
+{
+ int dev = iminor(inode) & 0x0f;
+ int ret = 0;
+ switch (dev) {
+ case VCHIQ_MINOR:
+ {
+ VCHIQ_INSTANCE_T instance = file->private_data;
+ int i;
+
+ vcos_log_info("vchiq_release: instance=%lx",
+ (unsigned long)instance);
+
+ instance->closing = 1;
+
+ /* Wake the slot handler if the completion queue is full */
+ vcos_event_signal(&instance->remove_event);
+
+ /* Mark all services for termination... */
+
+ for (i = 0; i < MAX_SERVICES; i++) {
+ USER_SERVICE_T *user_service =
+ &instance->services[i];
+ if (user_service->service != NULL)
+ {
+ /* Wake the slot handler if the msg queue is full */
+ vcos_event_signal(&user_service->remove_event);
+
+ if ((user_service->service->srvstate != VCHIQ_SRVSTATE_CLOSEWAIT) &&
+ (user_service->service->srvstate != VCHIQ_SRVSTATE_LISTENING))
+ {
+ vchiq_terminate_service_internal(user_service->service);
+ }
+ }
+ }
+
+ /* ...and wait for them to die */
+
+ for (i = 0; i < MAX_SERVICES; i++) {
+ USER_SERVICE_T *user_service =
+ &instance->services[i];
+ if (user_service->service != NULL)
+ {
+ /* Wait in this non-portable fashion because interruptible
+ calls will not block in this context. */
+ while ((user_service->service->srvstate != VCHIQ_SRVSTATE_CLOSEWAIT) &&
+ (user_service->service->srvstate != VCHIQ_SRVSTATE_LISTENING))
+ {
+ down(&user_service->service->remove_event);
+ }
+
+ vchiq_free_service_internal
+ (user_service->service);
+ }
+ }
+
+ vcos_event_delete(&instance->insert_event);
+ vcos_event_delete(&instance->remove_event);
+
+ kfree(instance);
+ file->private_data = NULL;
+ }
+ break;
+
+ default:
+ vcos_log_error("Unknown minor device: %d", dev);
+ ret = -ENXIO;
+ }
+
+ return ret;
+}
+
+/****************************************************************************
+*
+* vchiq_dump
+*
+***************************************************************************/
+
+void
+vchiq_dump(void *dump_context, const char *str, int len)
+{
+ DUMP_CONTEXT_T *context = (DUMP_CONTEXT_T *)dump_context;
+
+ if ((context->actual >= 0) && (context->actual < context->space))
+ {
+ int copy_bytes;
+ if (context->offset > 0)
+ {
+ int skip_bytes = vcos_min(len, context->offset);
+ str += skip_bytes;
+ len -= skip_bytes;
+ context->offset -= skip_bytes;
+ if (context->offset > 0)
+ return;
+ }
+ copy_bytes = vcos_min(len, context->space - context->actual);
+ if (copy_bytes == 0)
+ return;
+ if (copy_to_user(context->buf + context->actual, str, copy_bytes))
+ context->actual = -EFAULT;
+ context->actual += copy_bytes;
+ len -= copy_bytes;
+
+ /* If tne terminating NUL is included in the length, then it marks
+ * the end of a line and should be replaced with a carriage return.
+ */
+ if ((len == 0) && (str[copy_bytes - 1] == '\0'))
+ {
+ char cr = '\n';
+ if (copy_to_user(context->buf + context->actual - 1, &cr, 1))
+ {
+ context->actual = -EFAULT;
+ }
+ }
+ }
+}
+
+/****************************************************************************
+*
+* vchiq_dump_platform_instance_state
+*
+***************************************************************************/
+
+void
+vchiq_dump_platform_instances(void *dump_context)
+{
+ VCHIQ_STATE_T *state = vchiq_get_state();
+ char buf[80];
+ int len;
+ int i;
+
+ /* There is no list of instances, so instead scan all services,
+ marking those that have been dumped. */
+
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ VCHIQ_INSTANCE_T instance;
+
+ if (service
+ && ((instance = service->instance) != NULL)
+ && (service->base.callback == service_callback))
+ instance->mark = 0;
+ }
+
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ VCHIQ_INSTANCE_T instance;
+
+ if (service
+ && ((instance = service->instance) != NULL)
+ && (service->base.callback == service_callback))
+ {
+ if (!instance->mark)
+ {
+ len = vcos_snprintf(buf, sizeof(buf),
+ "Instance %x: pid %d,%s completions %d/%d",
+ (unsigned int)instance, instance->pid,
+ instance->connected ? " connected," : "",
+ instance->completion_insert - instance->completion_remove,
+ MAX_COMPLETIONS);
+
+ vchiq_dump(dump_context, buf, len + 1);
+
+ instance->mark = 1;
+ }
+ }
+ }
+}
+
+/****************************************************************************
+*
+* vchiq_dump_platform_service_state
+*
+***************************************************************************/
+
+void
+vchiq_dump_platform_service_state(void *dump_context, VCHIQ_SERVICE_T *service)
+{
+ USER_SERVICE_T *user_service = (USER_SERVICE_T *)service->base.userdata;
+ char buf[80];
+ int len;
+
+ len = vcos_snprintf(buf, sizeof(buf), " instance %x",
+ service->instance);
+
+ if ((service->base.callback == service_callback) && user_service->is_vchi)
+ {
+ len += vcos_snprintf(buf + len, sizeof(buf) - len,
+ ", %d/%d messages",
+ user_service->msg_insert - user_service->msg_remove,
+ MSG_QUEUE_SIZE);
+
+ if (user_service->dequeue_pending)
+ len += vcos_snprintf(buf + len, sizeof(buf) - len,
+ " (dequeue pending)");
+ }
+
+ vchiq_dump(dump_context, buf, len + 1);
+}
+
+/****************************************************************************
+*
+* vchiq_read
+*
+***************************************************************************/
+
+static ssize_t
+vchiq_read(struct file * file, char __user * buf,
+ size_t count, loff_t *ppos)
+{
+ DUMP_CONTEXT_T context;
+ context.buf = buf;
+ context.actual = 0;
+ context.space = count;
+ context.offset = *ppos;
+
+ vchiq_dump_state(&context, &g_state);
+
+ if (context.actual >= 0)
+ *ppos += context.actual;
+
+ return context.actual;
+}
+
+VCHIQ_STATE_T *
+vchiq_get_state(void)
+{
+
+ if (g_state.remote == NULL)
+ {
+ printk( "%s: g_state.remote == NULL\n", __func__ );
+ }
+ else
+ {
+ if ( g_state.remote->initialised != 1)
+ {
+ printk( "%s: g_state.remote->initialised != 1 (%d)\n", __func__, g_state.remote->initialised );
+ }
+ }
+
+ return ((g_state.remote != NULL) &&
+ (g_state.remote->initialised == 1)) ? &g_state : NULL;
+}
+
+static const struct file_operations
+vchiq_fops = {
+ .owner = THIS_MODULE,
+ .unlocked_ioctl = vchiq_ioctl,
+ .open = vchiq_open,
+ .release = vchiq_release,
+ .read = vchiq_read
+};
+
+/****************************************************************************
+*
+* vchiq_init - called when the module is loaded.
+*
+***************************************************************************/
+
+static int __init
+vchiq_init(void)
+{
+ int err;
+ void *ptr_err;
+
+ err = vchiq_platform_vcos_init();
+ if (err != 0)
+ goto failed_platform_vcos_init;
+
+ vcos_log_set_level(VCOS_LOG_CATEGORY, vchiq_default_arm_log_level);
+ vcos_log_register("vchiq_arm", VCOS_LOG_CATEGORY);
+
+ if ((err =
+ alloc_chrdev_region(&vchiq_devid, VCHIQ_MINOR, 1,
+ DEVICE_NAME)) != 0) {
+ vcos_log_error("Unable to allocate device number");
+ goto failed_alloc_chrdev;
+ }
+ cdev_init(&vchiq_cdev, &vchiq_fops);
+ vchiq_cdev.owner = THIS_MODULE;
+ if ((err = cdev_add(&vchiq_cdev, vchiq_devid, 1)) != 0) {
+ vcos_log_error("Unable to register device");
+ goto failed_cdev_add;
+ }
+
+ /* create sysfs entries */
+ vchiq_class = class_create(THIS_MODULE, DEVICE_NAME);
+ if (IS_ERR(ptr_err = vchiq_class))
+ goto failed_class_create;
+
+ vchiq_dev = device_create(vchiq_class, NULL,
+ vchiq_devid, NULL, "vchiq");
+ if (IS_ERR(ptr_err = vchiq_dev))
+ goto failed_device_create;
+
+ err = vchiq_platform_init(&g_state);
+ if (err != 0)
+ goto failed_platform_init;
+
+ vcos_log_error("vchiq: initialised - version %d (min %d), device %d.%d",
+ VCHIQ_VERSION, VCHIQ_VERSION_MIN,
+ MAJOR(vchiq_devid), MINOR(vchiq_devid));
+
+ return 0;
+
+failed_platform_init:
+ device_destroy(vchiq_class, vchiq_devid);
+failed_device_create:
+ class_destroy(vchiq_class);
+failed_class_create:
+ cdev_del(&vchiq_cdev);
+ err = PTR_ERR(ptr_err);
+failed_cdev_add:
+ unregister_chrdev_region(vchiq_devid, 1);
+failed_alloc_chrdev:
+failed_platform_vcos_init:
+ printk(KERN_WARNING "could not load vchiq\n");
+ return err;
+}
+/****************************************************************************
+*
+* vchiq_exit - called when the module is unloaded.
+*
+***************************************************************************/
+
+static void __exit
+vchiq_exit(void)
+{
+ vchiq_platform_exit(&g_state);
+ device_destroy(vchiq_class, vchiq_devid);
+ class_destroy(vchiq_class);
+ cdev_del(&vchiq_cdev);
+ unregister_chrdev_region(vchiq_devid, 1);
+ vcos_log_unregister(VCOS_LOG_CATEGORY);
+}
+
+module_init(vchiq_init);
+module_exit(vchiq_exit);
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Broadcom Corporation");
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_arm.h
@@ -0,0 +1,38 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_ARM_H
+#define VCHIQ_ARM_H
+
+#include "vchiq_core.h"
+
+extern VCOS_LOG_CAT_T vchiq_arm_log_category;
+
+extern int __init
+vchiq_platform_vcos_init(void);
+
+extern int __init
+vchiq_platform_init(VCHIQ_STATE_T *state);
+
+extern void __exit
+vchiq_platform_exit(VCHIQ_STATE_T *state);
+
+extern VCHIQ_STATE_T *
+vchiq_get_state(void);
+
+#endif /* VCHIQ_ARM_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_cfg.h
@@ -0,0 +1,43 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_CFG_H
+#define VCHIQ_CFG_H
+
+#define VCHIQ_MAGIC VCHIQ_MAKE_FOURCC('V','C','H','I')
+/* The version of VCHIQ - change with any non-trivial change */
+#define VCHIQ_VERSION 2
+/* The minimum compatible version - update to match VCHIQ_VERSION with any incompatible change */
+#define VCHIQ_VERSION_MIN 2
+
+#define VCHIQ_MAX_SERVICES 4096
+#define VCHIQ_MAX_SLOTS 128
+#define VCHIQ_MAX_SLOTS_PER_SIDE 64
+
+#define VCHIQ_NUM_CURRENT_BULKS 32
+#define VCHIQ_NUM_SERVICE_BULKS 4
+
+#ifndef VCHIQ_ENABLE_DEBUG
+#define VCHIQ_ENABLE_DEBUG 1
+#endif
+
+#ifndef VCHIQ_ENABLE_STATS
+#define VCHIQ_ENABLE_STATS 1
+#endif
+
+#endif /* VCHIQ_CFG_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_connected.c
@@ -0,0 +1,101 @@
+/*****************************************************************************
+* Copyright 2001 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#include "vcos.h"
+#include "vchiq_connected.h"
+#include <linux/module.h>
+
+#define MAX_CALLBACKS 10
+
+static int g_connected = 0;
+static int g_num_deferred_callbacks;
+static VCHIQ_CONNECTED_CALLBACK_T g_deferred_callback[ MAX_CALLBACKS ];
+static VCOS_ONCE_T g_once_init;
+static VCOS_MUTEX_T g_connected_mutex;
+
+extern VCOS_LOG_CAT_T vchiq_core_log_category;
+#define VCOS_LOG_CATEGORY (&vchiq_core_log_category)
+
+/****************************************************************************
+*
+* Function to initialize our lock.
+*
+***************************************************************************/
+
+static void connected_init( void )
+{
+ vcos_mutex_create( &g_connected_mutex, "connected_mutex");
+}
+
+/****************************************************************************
+*
+* This function is used to defer initialization until the vchiq stack is
+* initialized. If the stack is already initialized, then the callback will
+* be made immediately, otherwise it will be deferred until
+* vchiq_call_connected_callbacks is called.
+*
+***************************************************************************/
+
+void vchiq_add_connected_callback( VCHIQ_CONNECTED_CALLBACK_T callback )
+{
+ vcos_once( &g_once_init, connected_init );
+
+ vcos_mutex_lock( &g_connected_mutex );
+
+ if ( g_connected )
+ {
+ // We're already connected. Call the callback immediately.
+
+ callback();
+ }
+ else
+ {
+ if ( g_num_deferred_callbacks >= MAX_CALLBACKS )
+ {
+ vcos_log_error( "There already %d callback registered - please increase MAX_CALLBACKS",
+ g_num_deferred_callbacks );
+ }
+ else
+ {
+ g_deferred_callback[ g_num_deferred_callbacks ] = callback;
+ g_num_deferred_callbacks++;
+ }
+ }
+ vcos_mutex_unlock( &g_connected_mutex );
+}
+
+/****************************************************************************
+*
+* This function is called by the vchiq stack once it has been connected to
+* the videocore and clients can start to use the stack.
+*
+***************************************************************************/
+
+void vchiq_call_connected_callbacks( void )
+{
+ int i;
+
+ vcos_once( &g_once_init, connected_init );
+
+ vcos_mutex_lock( &g_connected_mutex );
+ for ( i = 0; i < g_num_deferred_callbacks; i++ )\
+ {
+ g_deferred_callback[i]();
+ }
+ g_num_deferred_callbacks = 0;
+ g_connected = 1;
+ vcos_mutex_unlock( &g_connected_mutex );
+}
+
+EXPORT_SYMBOL( vchiq_add_connected_callback );
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_connected.h
@@ -0,0 +1,32 @@
+/*****************************************************************************
+* Copyright 2001 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#ifndef VCHIQ_CONNECTED_H
+#define VCHIQ_CONNECTED_H
+
+/* ---- Include Files ----------------------------------------------------- */
+
+/* ---- Constants and Types ---------------------------------------------- */
+
+typedef void (*VCHIQ_CONNECTED_CALLBACK_T)( void );
+
+/* ---- Variable Externs ------------------------------------------------- */
+
+/* ---- Function Prototypes ---------------------------------------------- */
+
+void vchiq_add_connected_callback( VCHIQ_CONNECTED_CALLBACK_T callback );
+void vchiq_call_connected_callbacks( void );
+
+#endif /* VCHIQ_CONNECTED_H */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_core.c
@@ -0,0 +1,2604 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include "vchiq_core.h"
+
+#define VCHIQ_SLOT_HANDLER_STACK 8192
+
+#define SLOT_INFO_FROM_INDEX(state, index) (state->slot_info + (index))
+#define SLOT_DATA_FROM_INDEX(state, index) (state->slot_data + (index))
+#define SLOT_INDEX_FROM_DATA(state, data) (((unsigned int)((char *)data - (char *)state->slot_data)) / VCHIQ_SLOT_SIZE)
+#define SLOT_INDEX_FROM_INFO(state, info) ((unsigned int)(info - state->slot_info))
+#define SLOT_QUEUE_INDEX_FROM_POS(pos) ((int)((unsigned int)(pos) / VCHIQ_SLOT_SIZE))
+
+#define VCOS_LOG_CATEGORY (&vchiq_core_log_category)
+
+#define BULK_INDEX(x) (x & (VCHIQ_NUM_SERVICE_BULKS - 1))
+
+typedef struct bulk_waiter_struct
+{
+ VCOS_EVENT_T event;
+ int actual;
+} BULK_WAITER_T;
+
+typedef struct vchiq_open_payload_struct{
+ int fourcc;
+ int client_id;
+ short version;
+ short version_min;
+} VCHIQ_OPEN_PAYLOAD_T;
+
+vcos_static_assert(sizeof(VCHIQ_HEADER_T) == 8); /* we require this for consistency between endpoints */
+vcos_static_assert(IS_POW2(sizeof(VCHIQ_HEADER_T)));
+vcos_static_assert(IS_POW2(VCHIQ_NUM_CURRENT_BULKS));
+vcos_static_assert(IS_POW2(VCHIQ_NUM_SERVICE_BULKS));
+
+VCOS_LOG_CAT_T vchiq_core_log_category;
+VCOS_LOG_CAT_T vchiq_core_msg_log_category;
+VCOS_LOG_LEVEL_T vchiq_default_core_log_level = VCOS_LOG_WARN;
+VCOS_LOG_LEVEL_T vchiq_default_core_msg_log_level = VCOS_LOG_WARN;
+
+static const char *const srvstate_names[] =
+{
+ "FREE",
+ "HIDDEN",
+ "LISTENING",
+ "OPENING",
+ "OPEN",
+ "CLOSESENT",
+ "CLOSING",
+ "CLOSEWAIT"
+};
+
+static const char *const reason_names[] =
+{
+ "SERVICE_OPENED",
+ "SERVICE_CLOSED",
+ "MESSAGE_AVAILABLE",
+ "BULK_TRANSMIT_DONE",
+ "BULK_RECEIVE_DONE",
+ "BULK_TRANSMIT_ABORTED",
+ "BULK_RECEIVE_ABORTED"
+};
+
+static const char *const conn_state_names[] =
+{
+ "DISCONNECTED",
+ "CONNECTED",
+ "PAUSING",
+ "PAUSE_SENT",
+ "PAUSED",
+ "RESUMING"
+};
+
+static const char *msg_type_str( unsigned int msg_type )
+{
+ switch (msg_type) {
+ case VCHIQ_MSG_PADDING: return "PADDING";
+ case VCHIQ_MSG_CONNECT: return "CONNECT";
+ case VCHIQ_MSG_OPEN: return "OPEN";
+ case VCHIQ_MSG_OPENACK: return "OPENACK";
+ case VCHIQ_MSG_CLOSE: return "CLOSE";
+ case VCHIQ_MSG_DATA: return "DATA";
+ case VCHIQ_MSG_BULK_RX: return "BULK_RX";
+ case VCHIQ_MSG_BULK_TX: return "BULK_TX";
+ case VCHIQ_MSG_BULK_RX_DONE: return "BULK_RX_DONE";
+ case VCHIQ_MSG_BULK_TX_DONE: return "BULK_TX_DONE";
+ case VCHIQ_MSG_PAUSE: return "PAUSE";
+ case VCHIQ_MSG_RESUME: return "RESUME";
+ }
+ return "???";
+}
+
+static inline void
+vchiq_set_service_state(VCHIQ_SERVICE_T *service, int newstate)
+{
+ vcos_log_info("%d: srv:%d %s->%s", service->state->id, service->localport,
+ srvstate_names[service->srvstate],
+ srvstate_names[newstate]);
+ service->srvstate = newstate;
+}
+
+static inline VCHIQ_STATUS_T
+make_service_callback(VCHIQ_SERVICE_T *service, VCHIQ_REASON_T reason,
+ VCHIQ_HEADER_T *header, void *bulk_userdata)
+{
+ vcos_log_trace("%d: callback:%d (%s, %x, %x)", service->state->id,
+ service->localport, reason_names[reason],
+ (unsigned int)header, (unsigned int)bulk_userdata);
+ return service->base.callback(reason, header, &service->base, bulk_userdata);
+}
+
+static inline void
+vchiq_set_conn_state(VCHIQ_STATE_T *state, VCHIQ_CONNSTATE_T newstate)
+{
+ vcos_log_info("%d: %s->%s", state->id,
+ conn_state_names[state->conn_state],
+ conn_state_names[newstate]);
+ state->conn_state = newstate;
+}
+
+static inline void
+remote_event_create(REMOTE_EVENT_T *event)
+{
+ event->armed = 0;
+ /* Don't clear the 'fired' flag because it may already have been set by the other side */
+ vcos_event_create(event->event, "vchiq");
+}
+
+static inline void
+remote_event_destroy(REMOTE_EVENT_T *event)
+{
+ vcos_event_delete(event->event);
+}
+
+static inline int
+remote_event_wait(REMOTE_EVENT_T *event)
+{
+ if (!event->fired)
+ {
+ event->armed = 1;
+ if (event->fired) /* Also ensures the write has completed */
+ event->armed = 0;
+ else if (vcos_event_wait(event->event) != VCOS_SUCCESS)
+ return 0;
+ }
+
+ event->fired = 0;
+ return 1;
+}
+
+static inline void
+remote_event_signal_local(REMOTE_EVENT_T *event)
+{
+ event->armed = 0;
+ vcos_event_signal(event->event);
+}
+
+static inline void
+remote_event_poll(REMOTE_EVENT_T *event)
+{
+ if (event->armed)
+ remote_event_signal_local(event);
+}
+
+void
+remote_event_pollall(VCHIQ_STATE_T *state)
+{
+ remote_event_poll(&state->local->trigger);
+ remote_event_poll(&state->local->recycle);
+}
+
+/* Round up message sizes so that any space at the end of a slot is always big
+ enough for a header. This relies on header size being a power of two, which
+ has been verified earlier by a static assertion. */
+
+static inline unsigned int
+calc_stride(unsigned int size)
+{
+ /* Allow room for the header */
+ size += sizeof(VCHIQ_HEADER_T);
+
+ /* Round up */
+ return (size + sizeof(VCHIQ_HEADER_T) - 1) & ~(sizeof(VCHIQ_HEADER_T) - 1);
+}
+
+static VCHIQ_SERVICE_T *
+get_listening_service(VCHIQ_STATE_T *state, int fourcc)
+{
+ int i;
+
+ vcos_assert(fourcc != VCHIQ_FOURCC_INVALID);
+
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (service &&
+ (service->public_fourcc == fourcc) &&
+ ((service->srvstate == VCHIQ_SRVSTATE_LISTENING) ||
+ ((service->srvstate == VCHIQ_SRVSTATE_OPEN) &&
+ (service->remoteport == VCHIQ_PORT_FREE))))
+ return service;
+ }
+
+ return NULL;
+}
+
+static VCHIQ_SERVICE_T *
+get_connected_service(VCHIQ_STATE_T *state, unsigned int port)
+{
+ int i;
+ for (i = 0; i < state->unused_service; i++) {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (service && (service->srvstate == VCHIQ_SRVSTATE_OPEN)
+ && (service->remoteport == port)) {
+ return service;
+ }
+ }
+ return NULL;
+}
+
+static inline void
+request_poll(VCHIQ_STATE_T *state, VCHIQ_SERVICE_T *service, int poll_type)
+{
+ if (service)
+ {
+ vcos_atomic_flags_or(&service->poll_flags, (1 << poll_type));
+ vcos_atomic_flags_or(&state->poll_services[service->localport>>5],
+ (1 <<(service->localport & 0x1f)));
+ }
+
+ state->poll_needed = 1;
+ vcos_wmb(&state->poll_needed);
+
+ /* ... and ensure the slot handler runs. */
+ remote_event_signal_local(&state->local->trigger);
+}
+
+/* Called from queue_message, by the slot handler and application threads,
+ with slot_mutex held */
+static VCHIQ_HEADER_T *
+reserve_space(VCHIQ_STATE_T *state, int space, int is_blocking)
+{
+ VCHIQ_SHARED_STATE_T *local = state->local;
+ int tx_pos = state->local_tx_pos;
+ int slot_space = VCHIQ_SLOT_SIZE - (tx_pos & VCHIQ_SLOT_MASK);
+
+ if (space > slot_space) {
+ VCHIQ_HEADER_T *header;
+ /* Fill the remaining space with padding */
+ vcos_assert(state->tx_data != NULL);
+ header = (VCHIQ_HEADER_T *) (state->tx_data + (tx_pos & VCHIQ_SLOT_MASK));
+ header->msgid = VCHIQ_MSGID_PADDING;
+ header->size = slot_space - sizeof(VCHIQ_HEADER_T);
+
+ tx_pos += slot_space;
+ }
+
+ /* If necessary, get the next slot. */
+ if ((tx_pos & VCHIQ_SLOT_MASK) == 0)
+ {
+ int slot_index;
+
+ /* If there is no free slot... */
+ if (tx_pos == (state->slot_queue_available * VCHIQ_SLOT_SIZE))
+ {
+ /* ...wait for one. */
+ VCHIQ_STATS_INC(state, slot_stalls);
+
+ /* But first, flush through the last slot. */
+ local->tx_pos = tx_pos;
+ remote_event_signal(&state->remote->trigger);
+
+ do {
+ if (!is_blocking ||
+ (vcos_event_wait(&state->slot_available_event) != VCOS_SUCCESS))
+ {
+ return NULL; /* No space available now */
+ }
+ }
+ while (tx_pos == (state->slot_queue_available * VCHIQ_SLOT_SIZE));
+ }
+
+ slot_index = local->slot_queue[SLOT_QUEUE_INDEX_FROM_POS(tx_pos) & VCHIQ_SLOT_QUEUE_MASK];
+ state->tx_data = (char *)SLOT_DATA_FROM_INDEX(state, slot_index);
+ }
+
+ state->local_tx_pos = tx_pos + space;
+
+ return (VCHIQ_HEADER_T *)(state->tx_data + (tx_pos & VCHIQ_SLOT_MASK));
+}
+
+/* Called with slot_mutex held */
+static void
+process_free_queue(VCHIQ_STATE_T *state)
+{
+ VCHIQ_SHARED_STATE_T *local = state->local;
+ BITSET_T service_found[BITSET_SIZE(VCHIQ_MAX_SERVICES)];
+ int slot_queue_available;
+
+ /* Use a read memory barrier to ensure that any state that may have
+ been modified by another thread is not masked by stale prefetched
+ values. */
+ vcos_rmb();
+
+ /* Find slots which have been freed by the other side, and return them to
+ the available queue. */
+ slot_queue_available = state->slot_queue_available;
+
+ while (slot_queue_available != local->slot_queue_recycle)
+ {
+ int pos;
+ int slot_index = local->slot_queue[slot_queue_available++ & VCHIQ_SLOT_QUEUE_MASK];
+ char *data = (char *)SLOT_DATA_FROM_INDEX(state, slot_index);
+
+ vcos_log_trace("%d: pfq %d=%x %x %x", state->id, slot_index,
+ (unsigned int)data, local->slot_queue_recycle,
+ slot_queue_available);
+
+ /* Initialise the bitmask for services which have used this slot */
+ BITSET_ZERO(service_found);
+
+ pos = 0;
+
+ while (pos < VCHIQ_SLOT_SIZE)
+ {
+ VCHIQ_HEADER_T *header = (VCHIQ_HEADER_T *)(data + pos);
+ int msgid = header->msgid;
+ if (VCHIQ_MSG_TYPE(msgid) == VCHIQ_MSG_DATA)
+ {
+ int port = VCHIQ_MSG_SRCPORT(msgid);
+ if (!BITSET_IS_SET(service_found, port))
+ {
+ VCHIQ_SERVICE_QUOTA_T *service_quota =
+ &state->service_quotas[port];
+
+ /* Set the found bit for this service */
+ BITSET_SET(service_found, port);
+
+ if (service_quota->slot_use_count > 0)
+ {
+ service_quota->slot_use_count--;
+ /* Signal the service in case it has dropped below its quota */
+ vcos_event_signal(&service_quota->quota_event);
+ vcos_log_trace("%d: pfq:%d %x@%x - slot_use->%d",
+ state->id, port,
+ header->size, (unsigned int)header,
+ service_quota->slot_use_count);
+ }
+ else
+ {
+ vcos_log_error("service %d slot_use_count=%d (header %x,"
+ " msgid %x, header->msgid %x, header->size %x)",
+ port, service_quota->slot_use_count,
+ (unsigned int)header, msgid, header->msgid,
+ header->size);
+ vcos_assert(0);
+ }
+ }
+ }
+
+ pos += calc_stride(header->size);
+ if (pos > VCHIQ_SLOT_SIZE)
+ {
+ vcos_log_error("pos %x: header %x, msgid %x, header->msgid %x, header->size %x",
+ pos, (unsigned int)header, msgid, header->msgid, header->size);
+ vcos_assert(0);
+ }
+ }
+ }
+
+ if (slot_queue_available != state->slot_queue_available)
+ {
+ state->slot_queue_available = slot_queue_available;
+ vcos_wmb(&state->slot_queue_available);
+ vcos_event_signal(&state->slot_available_event);
+ }
+}
+
+/* Called by the slot handler and application threads */
+static VCHIQ_STATUS_T
+queue_message(VCHIQ_STATE_T *state, VCHIQ_SERVICE_T *service,
+ int msgid, const VCHIQ_ELEMENT_T *elements,
+ int count, int size, int is_blocking)
+{
+ VCHIQ_SHARED_STATE_T *local;
+ VCHIQ_SERVICE_QUOTA_T *service_quota = NULL;
+ VCHIQ_HEADER_T *header;
+
+ unsigned int stride;
+
+ local = state->local;
+
+ stride = calc_stride(size);
+
+ vcos_assert(stride <= VCHIQ_SLOT_SIZE);
+
+ /* On platforms where vcos_mutex_lock cannot fail, the return will never
+ be taken and the compiler may optimise out that code. Let Coverity
+ know this is intentional.
+ */
+ /* coverity[constant_expression_result] */
+ if ((VCHIQ_MSG_TYPE(msgid) != VCHIQ_MSG_RESUME) &&
+ (vcos_mutex_lock(&state->slot_mutex) != VCOS_SUCCESS))
+ return VCHIQ_RETRY;
+
+ if (service)
+ {
+ int tx_end_index = SLOT_QUEUE_INDEX_FROM_POS(state->local_tx_pos + stride - 1);
+
+ if (service->srvstate != VCHIQ_SRVSTATE_OPEN)
+ {
+ /* The service has been closed, probably while waiting for the mutex */
+ vcos_mutex_unlock(&state->slot_mutex);
+ return VCHIQ_ERROR;
+ }
+
+ service_quota = &state->service_quotas[service->localport];
+
+ /* ...ensure it doesn't use more than its quota of slots */
+ while ((tx_end_index != service_quota->previous_tx_index) &&
+ (service_quota->slot_use_count == service_quota->slot_quota))
+ {
+ vcos_log_trace("%d: qm:%d %s,%x - quota stall",
+ state->id, service->localport,
+ msg_type_str(VCHIQ_MSG_TYPE(msgid)), size);
+ VCHIQ_SERVICE_STATS_INC(service, quota_stalls);
+ vcos_mutex_unlock(&state->slot_mutex);
+ if (vcos_event_wait(&service_quota->quota_event) != VCOS_SUCCESS)
+ return VCHIQ_RETRY;
+ if (vcos_mutex_lock(&state->slot_mutex) != VCOS_SUCCESS)
+ return VCHIQ_RETRY;
+ vcos_assert(service_quota->slot_use_count <= service_quota->slot_quota);
+ tx_end_index = SLOT_QUEUE_INDEX_FROM_POS(state->local_tx_pos + stride - 1);
+ }
+ }
+
+ header = reserve_space(state, stride, is_blocking);
+
+ if (!header) {
+ if (service)
+ VCHIQ_SERVICE_STATS_INC(service, slot_stalls);
+ vcos_mutex_unlock(&state->slot_mutex);
+ return VCHIQ_RETRY;
+ }
+
+ if (service) {
+ int i, pos;
+ int tx_end_index;
+
+ vcos_log_info("%d: qm %s@%x,%x (%d->%d)", state->id,
+ msg_type_str(VCHIQ_MSG_TYPE(msgid)),
+ (unsigned int)header, size,
+ VCHIQ_MSG_SRCPORT(msgid),
+ VCHIQ_MSG_DSTPORT(msgid));
+
+ for (i = 0, pos = 0; i < (unsigned int)count;
+ pos += elements[i++].size)
+ if (elements[i].size) {
+ if (vchiq_copy_from_user
+ (header->data + pos, elements[i].data,
+ (size_t) elements[i].size) !=
+ VCHIQ_SUCCESS) {
+ vcos_mutex_unlock(&state->slot_mutex);
+ VCHIQ_SERVICE_STATS_INC(service, error_count);
+ return VCHIQ_ERROR;
+ }
+ if (i == 0) {
+ vcos_log_dump_mem( &vchiq_core_msg_log_category,
+ "Sent", 0, header->data + pos,
+ vcos_min( 64, elements[0].size ));
+ }
+ }
+
+ /* If this transmission can't fit in the last slot used by this service... */
+ tx_end_index = SLOT_QUEUE_INDEX_FROM_POS(state->local_tx_pos - 1);
+ if (tx_end_index != service_quota->previous_tx_index)
+ {
+ service_quota->slot_use_count++;
+ vcos_log_trace("%d: qm:%d %s,%x - slot_use->%d",
+ state->id, service->localport,
+ msg_type_str(VCHIQ_MSG_TYPE(msgid)), size,
+ service_quota->slot_use_count);
+ }
+
+ service_quota->previous_tx_index = tx_end_index;
+ VCHIQ_SERVICE_STATS_INC(service, ctrl_tx_count);
+ VCHIQ_SERVICE_STATS_ADD(service, ctrl_tx_bytes, size);
+ } else {
+ vcos_log_info("%d: qm %s@%x,%x (%d->%d)", state->id,
+ msg_type_str(VCHIQ_MSG_TYPE(msgid)),
+ (unsigned int)header, size,
+ VCHIQ_MSG_SRCPORT(msgid),
+ VCHIQ_MSG_DSTPORT(msgid));
+ if (size != 0)
+ {
+ vcos_assert((count == 1) && (size == elements[0].size));
+ memcpy(header->data, elements[0].data, elements[0].size);
+ }
+ VCHIQ_STATS_INC(state, ctrl_tx_count);
+ }
+
+ header->msgid = msgid;
+ header->size = size;
+
+ if (vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO))
+ {
+ int svc_fourcc;
+
+ svc_fourcc = service
+ ? service->base.fourcc
+ : VCHIQ_MAKE_FOURCC('?','?','?','?');
+
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "Sent Msg %s(%u) to %c%c%c%c s:%u d:%d len:%d",
+ msg_type_str(VCHIQ_MSG_TYPE(msgid)),
+ VCHIQ_MSG_TYPE(msgid),
+ VCHIQ_FOURCC_AS_4CHARS(svc_fourcc),
+ VCHIQ_MSG_SRCPORT(msgid),
+ VCHIQ_MSG_DSTPORT(msgid),
+ size );
+ }
+
+ /* Make the new tx_pos visible to the peer. */
+ local->tx_pos = state->local_tx_pos;
+ vcos_wmb(&local->tx_pos);
+
+ if (VCHIQ_MSG_TYPE(msgid) != VCHIQ_MSG_PAUSE)
+ vcos_mutex_unlock(&state->slot_mutex);
+
+ remote_event_signal(&state->remote->trigger);
+
+ return VCHIQ_SUCCESS;
+}
+
+static inline void
+claim_slot(VCHIQ_SLOT_INFO_T *slot)
+{
+ slot->use_count++;
+}
+
+static void
+release_slot(VCHIQ_STATE_T *state, VCHIQ_SLOT_INFO_T *slot_info)
+{
+ int release_count;
+ vcos_mutex_lock(&state->recycle_mutex);
+
+ release_count = slot_info->release_count;
+ slot_info->release_count = ++release_count;
+
+ if (release_count == slot_info->use_count)
+ {
+ int slot_queue_recycle;
+ /* Add to the freed queue */
+
+ /* A read barrier is necessary here to prevent speculative fetches of
+ remote->slot_queue_recycle from overtaking the mutex. */
+ vcos_rmb();
+
+ slot_queue_recycle = state->remote->slot_queue_recycle;
+ state->remote->slot_queue[slot_queue_recycle & VCHIQ_SLOT_QUEUE_MASK] =
+ SLOT_INDEX_FROM_INFO(state, slot_info);
+ state->remote->slot_queue_recycle = slot_queue_recycle + 1;
+ vcos_log_info("%d: release_slot %d - recycle->%x",
+ state->id, SLOT_INDEX_FROM_INFO(state, slot_info),
+ state->remote->slot_queue_recycle);
+
+ /* A write barrier is necessary, but remote_event_signal contains one. */
+ remote_event_signal(&state->remote->recycle);
+ }
+
+ vcos_mutex_unlock(&state->recycle_mutex);
+}
+
+/* Called by the slot handler - don't hold the bulk mutex */
+static VCHIQ_STATUS_T
+notify_bulks(VCHIQ_SERVICE_T *service, VCHIQ_BULK_QUEUE_T *queue)
+{
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ vcos_log_trace("%d: nb:%d %cx - p=%x rn=%x r=%x",
+ service->state->id, service->localport,
+ (queue == &service->bulk_tx) ? 't' : 'r',
+ queue->process, queue->remote_notify, queue->remove);
+
+ if (service->state->is_master)
+ {
+ while (queue->remote_notify != queue->process)
+ {
+ VCHIQ_BULK_T *bulk = &queue->bulks[BULK_INDEX(queue->remote_notify)];
+ int msgtype = (bulk->dir == VCHIQ_BULK_TRANSMIT) ?
+ VCHIQ_MSG_BULK_RX_DONE : VCHIQ_MSG_BULK_TX_DONE;
+ int msgid = VCHIQ_MAKE_MSG(msgtype, service->localport, service->remoteport);
+ VCHIQ_ELEMENT_T element = { &bulk->actual, 4 };
+ /* Only reply to non-dummy bulk requests */
+ if (bulk->remote_data)
+ {
+ status = queue_message(service->state, NULL, msgid, &element, 1, 4, 0);
+ if (status != VCHIQ_SUCCESS)
+ break;
+ }
+ queue->remote_notify++;
+ }
+ }
+ else
+ {
+ queue->remote_notify = queue->process;
+ }
+
+ if (status == VCHIQ_SUCCESS)
+ {
+ while (queue->remove != queue->remote_notify)
+ {
+ VCHIQ_BULK_T *bulk = &queue->bulks[BULK_INDEX(queue->remove)];
+
+ /* Only generate callbacks for non-dummy bulk requests */
+ if (bulk->data)
+ {
+ if (bulk->actual != VCHIQ_BULK_ACTUAL_ABORTED)
+ {
+ if (bulk->dir == VCHIQ_BULK_TRANSMIT)
+ {
+ VCHIQ_SERVICE_STATS_INC(service, bulk_tx_count);
+ VCHIQ_SERVICE_STATS_ADD(service, bulk_tx_bytes, bulk->actual);
+ }
+ else
+ {
+ VCHIQ_SERVICE_STATS_INC(service, bulk_rx_count);
+ VCHIQ_SERVICE_STATS_ADD(service, bulk_rx_bytes, bulk->actual);
+ }
+ }
+ else
+ {
+ VCHIQ_SERVICE_STATS_INC(service, bulk_aborted_count);
+ }
+ if (bulk->mode == VCHIQ_BULK_MODE_BLOCKING)
+ {
+ BULK_WAITER_T *waiter = (BULK_WAITER_T *)bulk->userdata;
+ if (waiter)
+ {
+ waiter->actual = bulk->actual;
+ vcos_event_signal(&waiter->event);
+ }
+ }
+ else if (bulk->mode == VCHIQ_BULK_MODE_CALLBACK)
+ {
+ VCHIQ_REASON_T reason = (bulk->dir == VCHIQ_BULK_TRANSMIT) ?
+ ((bulk->actual == VCHIQ_BULK_ACTUAL_ABORTED) ?
+ VCHIQ_BULK_TRANSMIT_ABORTED : VCHIQ_BULK_TRANSMIT_DONE) :
+ ((bulk->actual == VCHIQ_BULK_ACTUAL_ABORTED) ?
+ VCHIQ_BULK_RECEIVE_ABORTED : VCHIQ_BULK_RECEIVE_DONE);
+ status = make_service_callback(service, reason,
+ NULL, bulk->userdata);
+ if (status == VCHIQ_RETRY)
+ break;
+ }
+ }
+
+ queue->remove++;
+ vcos_event_signal(&service->bulk_remove_event);
+ }
+ }
+
+ if (status != VCHIQ_SUCCESS)
+ request_poll(service->state, service, (queue == &service->bulk_tx) ?
+ VCHIQ_POLL_TXNOTIFY : VCHIQ_POLL_RXNOTIFY);
+
+ return status;
+}
+
+/* Called by the slot handler thread */
+static void
+poll_services(VCHIQ_STATE_T *state)
+{
+ int group, i;
+
+ for (group = 0; group < BITSET_SIZE(state->unused_service); group++)
+ {
+ uint32_t flags;
+ flags = vcos_atomic_flags_get_and_clear(&state->poll_services[group]);
+ for (i = 0; flags; i++)
+ {
+ if (flags & (1 << i))
+ {
+ VCHIQ_SERVICE_T *service = state->services[(group<<5) + i];
+ uint32_t service_flags =
+ vcos_atomic_flags_get_and_clear(&service->poll_flags);
+ if (service_flags & (1 << VCHIQ_POLL_TERMINATE))
+ {
+ vcos_log_info("%d: ps - terminate %d<->%d", state->id, service->localport, service->remoteport);
+ if (vchiq_close_service_internal(service, 0/*!close_recvd*/) != VCHIQ_SUCCESS)
+ request_poll(state, service, VCHIQ_POLL_TERMINATE);
+ }
+ if (service_flags & (1 << VCHIQ_POLL_TXNOTIFY))
+ notify_bulks(service, &service->bulk_tx);
+ if (service_flags & (1 << VCHIQ_POLL_RXNOTIFY))
+ notify_bulks(service, &service->bulk_rx);
+ flags &= ~(1 << i);
+ }
+ }
+ }
+}
+
+/* Called by the slot handler or application threads, holding the bulk mutex. */
+static int
+resolve_bulks(VCHIQ_SERVICE_T *service, VCHIQ_BULK_QUEUE_T *queue)
+{
+ VCHIQ_STATE_T *state = service->state;
+ int resolved = 0;
+
+ while ((queue->process != queue->local_insert) &&
+ (queue->process != queue->remote_insert))
+ {
+ VCHIQ_BULK_T *bulk = &queue->bulks[BULK_INDEX(queue->process)];
+
+ vcos_log_trace("%d: rb:%d %cx - li=%x ri=%x p=%x",
+ state->id, service->localport,
+ (queue == &service->bulk_tx) ? 't' : 'r',
+ queue->local_insert, queue->remote_insert,
+ queue->process);
+
+ vcos_assert((int)(queue->local_insert - queue->process) > 0);
+ vcos_assert((int)(queue->remote_insert - queue->process) > 0);
+ vchiq_transfer_bulk(bulk);
+
+ if (vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO))
+ {
+ const char *header = (queue == &service->bulk_tx) ?
+ "Send Bulk to" : "Recv Bulk from";
+ if (bulk->actual != VCHIQ_BULK_ACTUAL_ABORTED)
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "%s %c%c%c%c d:%d len:%d %x<->%x",
+ header,
+ VCHIQ_FOURCC_AS_4CHARS(service->base.fourcc),
+ service->remoteport,
+ bulk->size,
+ (unsigned int)bulk->data,
+ (unsigned int)bulk->remote_data );
+ else
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "%s %c%c%c%c d:%d ABORTED - tx len:%d, rx len:%d %x<->%x",
+ header,
+ VCHIQ_FOURCC_AS_4CHARS(service->base.fourcc),
+ service->remoteport,
+ bulk->size,
+ bulk->remote_size,
+ (unsigned int)bulk->data,
+ (unsigned int)bulk->remote_data );
+ }
+
+ vchiq_complete_bulk(bulk);
+ queue->process++;
+ resolved++;
+ }
+ return resolved;
+}
+
+/* Called with the bulk_mutex held */
+static void
+abort_outstanding_bulks(VCHIQ_SERVICE_T *service, VCHIQ_BULK_QUEUE_T *queue)
+{
+ int is_tx = (queue == &service->bulk_tx);
+ vcos_log_trace("%d: aob:%d %cx - li=%x ri=%x p=%x",
+ service->state->id, service->localport, is_tx ? 't' : 'r',
+ queue->local_insert, queue->remote_insert, queue->process);
+
+ vcos_assert((int)(queue->local_insert - queue->process) >= 0);
+ vcos_assert((int)(queue->remote_insert - queue->process) >= 0);
+
+ while ((queue->process != queue->local_insert) ||
+ (queue->process != queue->remote_insert))
+ {
+ VCHIQ_BULK_T *bulk = &queue->bulks[BULK_INDEX(queue->process)];
+
+ if (queue->process == queue->remote_insert)
+ {
+ /* fabricate a matching dummy bulk */
+ bulk->remote_data = NULL;
+ bulk->remote_size = 0;
+ queue->remote_insert++;
+ }
+
+ if (queue->process != queue->local_insert)
+ {
+ vchiq_complete_bulk(bulk);
+
+ if (vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO))
+ {
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "%s %c%c%c%c d:%d ABORTED - tx len:%d, rx len:%d",
+ is_tx ? "Send Bulk to" : "Recv Bulk from",
+ VCHIQ_FOURCC_AS_4CHARS(service->base.fourcc),
+ service->remoteport,
+ bulk->size,
+ bulk->remote_size );
+ }
+ }
+ else
+ {
+ /* fabricate a matching dummy bulk */
+ bulk->data = NULL;
+ bulk->size = 0;
+ bulk->actual = VCHIQ_BULK_ACTUAL_ABORTED;
+ bulk->dir = is_tx ? VCHIQ_BULK_TRANSMIT : VCHIQ_BULK_RECEIVE;
+ queue->local_insert++;
+ }
+
+ queue->process++;
+ }
+}
+
+static void
+pause_bulks(VCHIQ_STATE_T *state)
+{
+ int i;
+
+ /* Block bulk transfers from all services */
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (!service || (service->srvstate != VCHIQ_SRVSTATE_OPEN))
+ continue;
+
+ vcos_log_trace("locking bulk_mutex for service %d", i);
+ vcos_mutex_lock(&service->bulk_mutex);
+ }
+}
+
+static void
+resume_bulks(VCHIQ_STATE_T *state)
+{
+ int i;
+
+ /* Poll all services in case any bulk transfers have been
+ deferred */
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (!service || (service->srvstate != VCHIQ_SRVSTATE_OPEN))
+ continue;
+
+ if (resolve_bulks(service, &service->bulk_tx))
+ request_poll(state, service, VCHIQ_POLL_TXNOTIFY);
+ if (resolve_bulks(service, &service->bulk_rx))
+ request_poll(state, service, VCHIQ_POLL_RXNOTIFY);
+ vcos_log_trace("unlocking bulk_mutex for service %d", i);
+ vcos_mutex_unlock(&service->bulk_mutex);
+ }
+}
+
+/* Called by the slot handler thread */
+static void
+parse_rx_slots(VCHIQ_STATE_T *state)
+{
+ VCHIQ_SHARED_STATE_T *remote = state->remote;
+ int tx_pos;
+ DEBUG_INITIALISE(state->local)
+
+ tx_pos = remote->tx_pos;
+
+ while (state->rx_pos != tx_pos) {
+ VCHIQ_SERVICE_T *service = NULL;
+ VCHIQ_HEADER_T *header;
+ int msgid, size;
+ int type;
+ unsigned int localport, remoteport;
+
+ DEBUG_TRACE(PARSE_LINE);
+ if (!state->rx_data)
+ {
+ int rx_index;
+ vcos_assert((state->rx_pos & VCHIQ_SLOT_MASK) == 0);
+ rx_index = remote->slot_queue[SLOT_QUEUE_INDEX_FROM_POS(state->rx_pos) & VCHIQ_SLOT_QUEUE_MASK];
+ state->rx_data = (char *)SLOT_DATA_FROM_INDEX(state, rx_index);
+ state->rx_info = SLOT_INFO_FROM_INDEX(state, rx_index);
+
+ /* Initialise use_count to one, and increment release_count at the end
+ of the slot to avoid releasing the slot prematurely. */
+ state->rx_info->use_count = 1;
+ state->rx_info->release_count = 0;
+ }
+
+ header = (VCHIQ_HEADER_T *)(state->rx_data + (state->rx_pos & VCHIQ_SLOT_MASK));
+ DEBUG_VALUE(PARSE_HEADER, (int)header);
+ msgid = header->msgid;
+ DEBUG_VALUE(PARSE_MSGID, msgid);
+ size = header->size;
+ type = VCHIQ_MSG_TYPE(msgid);
+ localport = VCHIQ_MSG_DSTPORT(msgid);
+ remoteport = VCHIQ_MSG_SRCPORT(msgid);
+
+ if (type != VCHIQ_MSG_DATA)
+ {
+ VCHIQ_STATS_INC(state, ctrl_rx_count);
+ }
+
+ switch (type)
+ {
+ case VCHIQ_MSG_OPENACK:
+ case VCHIQ_MSG_CLOSE:
+ case VCHIQ_MSG_DATA:
+ case VCHIQ_MSG_BULK_RX:
+ case VCHIQ_MSG_BULK_TX:
+ case VCHIQ_MSG_BULK_RX_DONE:
+ case VCHIQ_MSG_BULK_TX_DONE:
+ if (localport <= VCHIQ_PORT_MAX)
+ {
+ service = state->services[localport];
+ if (service && (service->srvstate == VCHIQ_SRVSTATE_FREE))
+ service = NULL;
+ }
+ if (!service)
+ {
+ vcos_log_error(
+ "%d: prs %s@%x (%d->%d) - invalid/closed service %d",
+ state->id, msg_type_str(type), (unsigned int)header,
+ remoteport, localport, localport);
+ goto skip_message;
+ }
+ default:
+ break;
+ }
+
+ if ( vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO))
+ {
+ int svc_fourcc;
+
+ svc_fourcc = service
+ ? service->base.fourcc
+ : VCHIQ_MAKE_FOURCC('?','?','?','?');
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "Rcvd Msg %s(%u) from %c%c%c%c s:%d d:%d len:%d",
+ msg_type_str(type), type,
+ VCHIQ_FOURCC_AS_4CHARS(svc_fourcc),
+ remoteport, localport, size );
+ if (size > 0) {
+ vcos_log_dump_mem( &vchiq_core_msg_log_category,
+ "Rcvd", 0, header->data,
+ vcos_min( 64, size ));
+ }
+ }
+
+ if (((unsigned int)header & VCHIQ_SLOT_MASK) + calc_stride(size) > VCHIQ_SLOT_SIZE)
+ {
+ vcos_log_error("header %x (msgid %x) - size %x too big for slot",
+ (unsigned int)header, (unsigned int)msgid, (unsigned int)size);
+ vcos_assert(0);
+ }
+
+ switch (type) {
+ case VCHIQ_MSG_OPEN:
+ vcos_assert(VCHIQ_MSG_DSTPORT(msgid) == 0);
+ if (vcos_verify(size == sizeof(VCHIQ_OPEN_PAYLOAD_T))) {
+ const VCHIQ_OPEN_PAYLOAD_T *payload = (VCHIQ_OPEN_PAYLOAD_T *)header->data;
+ unsigned int fourcc;
+
+ fourcc = payload->fourcc;
+ vcos_log_info("%d: prs OPEN@%x (%d->'%c%c%c%c')",
+ state->id, (unsigned int)header,
+ localport,
+ VCHIQ_FOURCC_AS_4CHARS(fourcc));
+
+ service = get_listening_service(state, fourcc);
+
+ if (service)
+ {
+ /* A matching service exists */
+ short version = payload->version;
+ short version_min = payload->version_min;
+ if ((service->version < version_min) ||
+ (version < service->version_min))
+ {
+ /* Version mismatch */
+ vcos_log_error("%d: service %d (%c%c%c%c) version mismatch -"
+ " local (%d, min %d) vs. remote (%d, min %d)",
+ state->id, service->localport,
+ VCHIQ_FOURCC_AS_4CHARS(fourcc),
+ service->version, service->version_min,
+ version, version_min);
+ goto fail_open;
+ }
+ if (service->srvstate == VCHIQ_SRVSTATE_LISTENING)
+ {
+ /* Acknowledge the OPEN */
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_OPENACK, service->localport, remoteport),
+ NULL, 0, 0, 0) == VCHIQ_RETRY)
+ return; /* Bail out if not ready */
+
+ /* The service is now open */
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_OPEN);
+ }
+
+ service->remoteport = remoteport;
+ service->client_id = ((int *)header->data)[1];
+ if (make_service_callback(service, VCHIQ_SERVICE_OPENED,
+ NULL, NULL) == VCHIQ_RETRY)
+ {
+ /* Bail out if not ready */
+ service->remoteport = VCHIQ_PORT_FREE;
+ return;
+ }
+
+ /* Break out, and skip the failure handling */
+ break;
+ }
+ }
+ fail_open:
+ /* No available service, or an invalid request - send a CLOSE */
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_CLOSE, 0, VCHIQ_MSG_SRCPORT(msgid)),
+ NULL, 0, 0, 0) == VCHIQ_RETRY)
+ return; /* Bail out if not ready */
+ break;
+ case VCHIQ_MSG_OPENACK:
+ {
+ vcos_log_info("%d: prs OPENACK@%x (%d->%d)",
+ state->id, (unsigned int)header,
+ remoteport, localport);
+ if (service->srvstate == VCHIQ_SRVSTATE_OPENING) {
+ service->remoteport = remoteport;
+ vchiq_set_service_state(service,
+ VCHIQ_SRVSTATE_OPEN);
+ vcos_event_signal(&service->remove_event);
+ }
+ }
+ break;
+ case VCHIQ_MSG_CLOSE:
+ {
+ vcos_assert(size == 0); /* There should be no data */
+
+ vcos_log_info("%d: prs CLOSE@%x (%d->%d)",
+ state->id, (unsigned int)header,
+ remoteport, localport);
+
+ if ((service->remoteport != remoteport) &&
+ VCHIQ_PORT_IS_VALID(service->remoteport)) {
+ /* This could be from a client which hadn't yet received
+ the OPENACK - look for the connected service */
+ service = get_connected_service(state, remoteport);
+ if (!service)
+ break;
+ }
+
+ if (vchiq_close_service_internal(service,
+ 1/*close_recvd*/) == VCHIQ_RETRY)
+ return; /* Bail out if not ready */
+
+ if (vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO))
+ {
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "Close Service %c%c%c%c s:%u d:%d",
+ VCHIQ_FOURCC_AS_4CHARS(service->base.fourcc),
+ service->localport,
+ service->remoteport );
+ }
+ }
+ break;
+ case VCHIQ_MSG_DATA:
+ {
+ vcos_log_trace("%d: prs DATA@%x,%x (%d->%d)",
+ state->id, (unsigned int)header, size,
+ remoteport, localport);
+
+ if ((service->remoteport == remoteport)
+ && (service->srvstate ==
+ VCHIQ_SRVSTATE_OPEN)) {
+ header->msgid = msgid | VCHIQ_MSGID_CLAIMED;
+ claim_slot(state->rx_info);
+ DEBUG_TRACE(PARSE_LINE);
+ if (make_service_callback(service,
+ VCHIQ_MESSAGE_AVAILABLE, header,
+ NULL) == VCHIQ_RETRY)
+ {
+ DEBUG_TRACE(PARSE_LINE);
+ return; /* Bail out if not ready */
+ }
+ VCHIQ_SERVICE_STATS_INC(service, ctrl_rx_count);
+ VCHIQ_SERVICE_STATS_ADD(service, ctrl_rx_bytes, size);
+ }
+ else
+ {
+ VCHIQ_STATS_INC(state, error_count);
+ }
+ }
+ break;
+ case VCHIQ_MSG_CONNECT:
+ vcos_log_info("%d: prs CONNECT@%x",
+ state->id, (unsigned int)header);
+ vcos_event_signal(&state->connect);
+ break;
+ case VCHIQ_MSG_BULK_RX:
+ case VCHIQ_MSG_BULK_TX:
+ {
+ VCHIQ_BULK_QUEUE_T *queue;
+ vcos_assert(state->is_master);
+ queue = (type == VCHIQ_MSG_BULK_RX) ?
+ &service->bulk_tx : &service->bulk_rx;
+ if ((service->remoteport == remoteport)
+ && (service->srvstate ==
+ VCHIQ_SRVSTATE_OPEN))
+ {
+ VCHIQ_BULK_T *bulk;
+ int resolved;
+
+ vcos_assert(queue->remote_insert < queue->remove +
+ VCHIQ_NUM_SERVICE_BULKS);
+ bulk = &queue->bulks[BULK_INDEX(queue->remote_insert)];
+ bulk->remote_data = (void *)((int *)header->data)[0];
+ bulk->remote_size = ((int *)header->data)[1];
+
+ vcos_log_info("%d: prs %s@%x (%d->%d) %x@%x",
+ state->id, msg_type_str(type),
+ (unsigned int)header,
+ remoteport, localport,
+ bulk->remote_size,
+ (unsigned int)bulk->remote_data);
+
+ queue->remote_insert++;
+
+ if (state->conn_state != VCHIQ_CONNSTATE_CONNECTED)
+ break;
+
+ DEBUG_TRACE(PARSE_LINE);
+ if (vcos_mutex_lock(&service->bulk_mutex) != VCOS_SUCCESS)
+ {
+ DEBUG_TRACE(PARSE_LINE);
+ return;
+ }
+ DEBUG_TRACE(PARSE_LINE);
+ resolved = resolve_bulks(service, queue);
+ vcos_mutex_unlock(&service->bulk_mutex);
+ if (resolved)
+ notify_bulks(service, queue);
+ }
+ }
+ break;
+ case VCHIQ_MSG_BULK_RX_DONE:
+ case VCHIQ_MSG_BULK_TX_DONE:
+ {
+ vcos_assert(!state->is_master);
+ if ((service->remoteport == remoteport)
+ && (service->srvstate !=
+ VCHIQ_SRVSTATE_FREE)) {
+ VCHIQ_BULK_QUEUE_T *queue;
+ VCHIQ_BULK_T *bulk;
+
+ queue = (type == VCHIQ_MSG_BULK_RX_DONE) ?
+ &service->bulk_rx : &service->bulk_tx;
+
+ bulk = &queue->bulks[BULK_INDEX(queue->process)];
+ bulk->actual = *(int *)header->data;
+
+ vcos_log_info("%d: prs %s@%x (%d->%d) %x@%x",
+ state->id, msg_type_str(type),
+ (unsigned int)header,
+ remoteport, localport,
+ bulk->actual, (unsigned int)bulk->data);
+
+ vcos_log_trace("%d: prs:%d %cx li=%x ri=%x p=%x",
+ state->id, localport,
+ (type == VCHIQ_MSG_BULK_RX_DONE) ? 'r' : 't',
+ queue->local_insert,
+ queue->remote_insert, queue->process);
+
+ DEBUG_TRACE(PARSE_LINE);
+ if (vcos_mutex_lock(&service->bulk_mutex) != VCOS_SUCCESS)
+ {
+ DEBUG_TRACE(PARSE_LINE);
+ return;
+ }
+ DEBUG_TRACE(PARSE_LINE);
+ vcos_assert(queue->process != queue->local_insert);
+ vchiq_complete_bulk(bulk);
+ queue->process++;
+ vcos_mutex_unlock(&service->bulk_mutex);
+ DEBUG_TRACE(PARSE_LINE);
+ notify_bulks(service, queue);
+ DEBUG_TRACE(PARSE_LINE);
+ }
+ }
+ break;
+ case VCHIQ_MSG_PADDING:
+ vcos_log_trace("%d: prs PADDING@%x,%x",
+ state->id, (unsigned int)header, size);
+ break;
+ case VCHIQ_MSG_PAUSE:
+ /* If initiated, signal the application thread */
+ vcos_log_trace("%d: prs PAUSE@%x,%x",
+ state->id, (unsigned int)header, size);
+ if (state->conn_state != VCHIQ_CONNSTATE_PAUSE_SENT)
+ {
+ /* Send a PAUSE in response */
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_PAUSE, 0, 0),
+ NULL, 0, 0, 0) == VCHIQ_RETRY)
+ return; /* Bail out if not ready */
+ if (state->is_master)
+ pause_bulks(state);
+ }
+ /* At this point slot_mutex is held */
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_PAUSED);
+ vchiq_platform_paused(state);
+ break;
+ case VCHIQ_MSG_RESUME:
+ vcos_log_trace("%d: prs RESUME@%x,%x",
+ state->id, (unsigned int)header, size);
+ /* Release the slot mutex */
+ vcos_mutex_unlock(&state->slot_mutex);
+ if (state->is_master)
+ resume_bulks(state);
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_CONNECTED);
+ vchiq_platform_resumed(state);
+ break;
+ default:
+ vcos_log_error("%d: prs invalid msgid %x@%x,%x",
+ state->id, msgid, (unsigned int)header, size);
+ vcos_assert(0);
+ break;
+ }
+
+ skip_message:
+ state->rx_pos += calc_stride(size);
+
+ DEBUG_TRACE(PARSE_LINE);
+ /* Perform some housekeeping when the end of the slot is reached. */
+ if ((state->rx_pos & VCHIQ_SLOT_MASK) == 0)
+ {
+ /* Remove the extra reference count. */
+ release_slot(state, state->rx_info);
+ state->rx_data = NULL;
+ }
+ }
+}
+
+/* Called by the slot handler thread */
+static void *
+slot_handler_func(void *v)
+{
+ VCHIQ_STATE_T *state = (VCHIQ_STATE_T *) v;
+ VCHIQ_SHARED_STATE_T *local = state->local;
+ DEBUG_INITIALISE(local)
+
+ while (1) {
+ DEBUG_COUNT(SLOT_HANDLER_COUNT);
+ DEBUG_TRACE(SLOT_HANDLER_LINE);
+ remote_event_wait(&local->trigger);
+
+ vcos_rmb();
+
+ DEBUG_TRACE(SLOT_HANDLER_LINE);
+ if (state->poll_needed)
+ {
+ state->poll_needed = 0;
+
+ /* Handle service polling and other rare conditions here out
+ of the mainline code */
+ switch (state->conn_state)
+ {
+ case VCHIQ_CONNSTATE_CONNECTED:
+ /* Poll the services as requested */
+ poll_services(state);
+ break;
+
+ case VCHIQ_CONNSTATE_PAUSING:
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_PAUSE, 0, 0), NULL, 0, 0, 0)
+ != VCHIQ_RETRY)
+ {
+ if (state->is_master)
+ pause_bulks(state);
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_PAUSE_SENT);
+ }
+ else
+ {
+ state->poll_needed = 1; /* Retry later */
+ }
+ break;
+
+ case VCHIQ_CONNSTATE_RESUMING:
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_RESUME, 0, 0), NULL, 0, 0, 0)
+ != VCHIQ_RETRY)
+ {
+ if (state->is_master)
+ resume_bulks(state);
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_CONNECTED);
+ vchiq_platform_resumed(state);
+ }
+ else
+ {
+ /* This should really be impossible, since the PAUSE should
+ have flushed through outstanding messages. */
+ vcos_log_error("Failed to send RESUME message");
+ vcos_demand(0);
+ }
+ break;
+ default:
+ break;
+ }
+ }
+
+ DEBUG_TRACE(SLOT_HANDLER_LINE);
+ parse_rx_slots(state);
+ }
+ return NULL;
+}
+
+extern VCHIQ_STATUS_T
+vchiq_platform_suspend(VCHIQ_STATE_T *state);
+
+/* Called by the recycle thread */
+static void *
+recycle_func(void *v)
+{
+ VCHIQ_STATE_T *state = (VCHIQ_STATE_T *) v;
+ VCHIQ_SHARED_STATE_T *local = state->local;
+
+ while (1) {
+ remote_event_wait(&local->recycle);
+
+ vcos_mutex_lock(&state->slot_mutex);
+
+ process_free_queue(state);
+
+ vcos_mutex_unlock(&state->slot_mutex);
+ }
+ return NULL;
+}
+
+/* Called by the lp thread */
+static void *
+lp_func(void *v)
+{
+ VCHIQ_STATE_T *state = (VCHIQ_STATE_T *) v;
+
+ while (1) {
+ vcos_event_wait(&state->lp_evt);
+ vcos_mutex_lock(&state->use_count_mutex);
+ if (state->videocore_use_count == 0)
+ {
+ vchiq_platform_suspend(state);
+ }
+ vcos_mutex_unlock(&state->use_count_mutex);
+ }
+ return NULL;
+}
+
+static void
+init_bulk_queue(VCHIQ_BULK_QUEUE_T *queue)
+{
+ queue->local_insert = 0;
+ queue->remote_insert = 0;
+ queue->process = 0;
+ queue->remote_notify = 0;
+ queue->remove = 0;
+}
+
+VCHIQ_SLOT_ZERO_T *
+vchiq_init_slots(void *mem_base, int mem_size)
+{
+ int mem_align = (VCHIQ_SLOT_SIZE - (int)mem_base) & VCHIQ_SLOT_MASK;
+ VCHIQ_SLOT_ZERO_T *slot_zero = (VCHIQ_SLOT_ZERO_T *)((char *)mem_base + mem_align);
+ int num_slots = (mem_size - mem_align)/VCHIQ_SLOT_SIZE;
+ int first_data_slot = VCHIQ_SLOT_ZERO_SLOTS;
+
+ /* Ensure there is enough memory to run an absolutely minimum system */
+ num_slots -= first_data_slot;
+
+ if (num_slots < 4)
+ {
+ vcos_log_error("vchiq_init_slots - insufficient memory %x bytes", mem_size);
+ return NULL;
+ }
+
+ memset(slot_zero, 0, sizeof(VCHIQ_SLOT_ZERO_T));
+
+ slot_zero->magic = VCHIQ_MAGIC;
+ slot_zero->version = VCHIQ_VERSION;
+ slot_zero->version_min = VCHIQ_VERSION_MIN;
+ slot_zero->slot_zero_size = sizeof(VCHIQ_SLOT_ZERO_T);
+ slot_zero->slot_size = VCHIQ_SLOT_SIZE;
+ slot_zero->max_slots = VCHIQ_MAX_SLOTS;
+ slot_zero->max_slots_per_side = VCHIQ_MAX_SLOTS_PER_SIDE;
+
+ slot_zero->master.slot_first = first_data_slot;
+ slot_zero->slave.slot_first = first_data_slot + (num_slots/2);
+ slot_zero->master.slot_last = slot_zero->slave.slot_first - 1;
+ slot_zero->slave.slot_last = first_data_slot + num_slots - 1;
+
+ return slot_zero;
+}
+
+VCHIQ_STATUS_T
+vchiq_init_state(VCHIQ_STATE_T *state, VCHIQ_SLOT_ZERO_T *slot_zero, int is_master)
+{
+ VCHIQ_SHARED_STATE_T *local;
+ VCHIQ_SHARED_STATE_T *remote;
+ VCOS_THREAD_ATTR_T attrs;
+ char threadname[10];
+ static int id = 0;
+ int i;
+
+ vcos_log_set_level(&vchiq_core_log_category, vchiq_default_core_log_level);
+ vcos_log_set_level(&vchiq_core_msg_log_category, vchiq_default_core_msg_log_level);
+ vcos_log_register("vchiq_core", &vchiq_core_log_category);
+ vcos_log_register("vchiq_core_msg", &vchiq_core_msg_log_category);
+
+ vcos_log_warn( "%s: slot_zero = 0x%08lx, is_master = %d\n", __func__, (unsigned long)slot_zero, is_master );
+
+ /* Check the input configuration */
+
+ if (slot_zero->magic != VCHIQ_MAGIC)
+ {
+ vcos_log_error("slot_zero=%x: magic=%x (expected %x)",
+ (unsigned int)slot_zero, slot_zero->magic, VCHIQ_MAGIC);
+ return VCHIQ_ERROR;
+ }
+
+ if (slot_zero->version < VCHIQ_VERSION_MIN)
+ {
+ vcos_log_error("slot_zero=%x: peer_version=%x (minimum %x)",
+ (unsigned int)slot_zero, slot_zero->version, VCHIQ_VERSION_MIN);
+ return VCHIQ_ERROR;
+ }
+
+ if (VCHIQ_VERSION < slot_zero->version_min)
+ {
+ vcos_log_error("slot_zero=%x: version=%x (peer minimum %x)",
+ (unsigned int)slot_zero, VCHIQ_VERSION, slot_zero->version_min);
+ return VCHIQ_ERROR;
+ }
+
+ if (slot_zero->slot_zero_size != sizeof(VCHIQ_SLOT_ZERO_T))
+ {
+ vcos_log_error("slot_zero=%x: slot_zero_size=%x (expected %x)",
+ (unsigned int)slot_zero, slot_zero->slot_zero_size, sizeof(VCHIQ_SLOT_ZERO_T));
+ return VCHIQ_ERROR;
+ }
+
+ if (slot_zero->slot_size != VCHIQ_SLOT_SIZE)
+ {
+ vcos_log_error("slot_zero=%x: slot_size=%d (expected %d",
+ (unsigned int)slot_zero, slot_zero->slot_size, VCHIQ_SLOT_SIZE);
+ return VCHIQ_ERROR;
+ }
+
+ if (slot_zero->max_slots != VCHIQ_MAX_SLOTS)
+ {
+ vcos_log_error("slot_zero=%x: max_slots=%d (expected %d)",
+ (unsigned int)slot_zero, slot_zero->max_slots, VCHIQ_MAX_SLOTS);
+ return VCHIQ_ERROR;
+ }
+
+ if (slot_zero->max_slots_per_side != VCHIQ_MAX_SLOTS_PER_SIDE)
+ {
+ vcos_log_error("slot_zero=%x: max_slots_per_side=%d (expected %d)",
+ (unsigned int)slot_zero, slot_zero->max_slots_per_side,
+ VCHIQ_MAX_SLOTS_PER_SIDE);
+ return VCHIQ_ERROR;
+ }
+
+ if (is_master)
+ {
+ local = &slot_zero->master;
+ remote = &slot_zero->slave;
+ }
+ else
+ {
+ local = &slot_zero->slave;
+ remote = &slot_zero->master;
+ }
+
+ if (local->initialised)
+ {
+ if (remote->initialised)
+ vcos_log_error("vchiq: FATAL: local state has already been initialised");
+ else
+ vcos_log_error("vchiq: FATAL: master/slave mismatch - two %ss", is_master ? "master" : "slave");
+ return VCHIQ_ERROR;
+ }
+
+ memset(state, 0, sizeof(VCHIQ_STATE_T));
+ state->id = id++;
+ state->is_master = is_master;
+
+ /*
+ initialize shared state pointers
+ */
+
+ state->local = local;
+ state->remote = remote;
+ state->slot_data = (VCHIQ_SLOT_T *)slot_zero;
+
+ /*
+ initialize events and mutexes
+ */
+
+ vcos_event_create(&state->connect, "v.connect");
+ vcos_mutex_create(&state->mutex, "v.mutex");
+ vcos_event_create(&state->trigger_event, "v.trigger_event");
+ vcos_event_create(&state->recycle_event, "v.recycle_event");
+
+ vcos_mutex_create(&state->slot_mutex, "v.slot_mutex");
+ vcos_mutex_create(&state->recycle_mutex, "v.recycle_mutex");
+ vcos_mutex_create(&state->use_count_mutex, "v.use_count_mutex");
+ vcos_mutex_create(&state->suspend_resume_mutex, "v.susp_res_mutex");
+
+ vcos_event_create(&state->slot_available_event, "v.slot_available_event");
+ vcos_event_create(&state->slot_remove_event, "v.slot_remove_event");
+
+ state->slot_queue_available = 0;
+
+ for (i = 0; i < VCHIQ_MAX_SERVICES; i++)
+ {
+ VCHIQ_SERVICE_QUOTA_T *service_quota = &state->service_quotas[i];
+ vcos_event_create(&service_quota->quota_event, "v.quota_event");
+ }
+
+ for (i = local->slot_first; i <= local->slot_last; i++)
+ {
+ local->slot_queue[state->slot_queue_available++] = i;
+ }
+
+ state->default_slot_quota = state->slot_queue_available/2;
+
+ local->trigger.event = &state->trigger_event;
+ remote_event_create(&local->trigger);
+ local->tx_pos = 0;
+
+ local->recycle.event = &state->recycle_event;
+ remote_event_create(&local->recycle);
+ local->slot_queue_recycle = state->slot_queue_available;
+
+ vcos_event_create(&state->lp_evt, "LP_EVT");
+
+ local->debug[DEBUG_ENTRIES] = DEBUG_MAX;
+
+ /*
+ bring up slot handler thread
+ */
+
+ vcos_thread_attr_init(&attrs);
+ vcos_thread_attr_setstacksize(&attrs, VCHIQ_SLOT_HANDLER_STACK);
+ vcos_thread_attr_setpriority(&attrs, VCOS_THREAD_PRI_REALTIME);
+ vcos_snprintf(threadname, sizeof(threadname), "VCHIQ-%d", state->id);
+ if (vcos_thread_create(&state->slot_handler_thread, threadname,
+ &attrs, slot_handler_func, state) != VCOS_SUCCESS)
+ return VCHIQ_ERROR;
+
+ vcos_thread_attr_init(&attrs);
+ vcos_thread_attr_setstacksize(&attrs, VCHIQ_SLOT_HANDLER_STACK);
+ vcos_thread_attr_setpriority(&attrs, VCOS_THREAD_PRI_REALTIME);
+ vcos_snprintf(threadname, sizeof(threadname), "VCHIQr-%d", state->id);
+ if (vcos_thread_create(&state->recycle_thread, threadname,
+ &attrs, recycle_func, state) != VCOS_SUCCESS)
+ return VCHIQ_ERROR;
+
+ vcos_thread_attr_init(&attrs);
+ vcos_thread_attr_setstacksize(&attrs, VCHIQ_SLOT_HANDLER_STACK);
+ vcos_thread_attr_setpriority(&attrs, VCOS_THREAD_PRI_LOWEST);
+ vcos_snprintf(threadname, sizeof(threadname), "VCHIQl-%d", state->id);
+ if (vcos_thread_create(&state->lp_thread, threadname,
+ &attrs, lp_func, state) != VCOS_SUCCESS)
+ return VCHIQ_ERROR;
+
+ /* Indicate readiness to the other side */
+ local->initialised = 1;
+
+ return VCHIQ_SUCCESS;
+}
+
+/* Called from application thread when a client or server service is created. */
+VCHIQ_SERVICE_T *
+vchiq_add_service_internal(VCHIQ_STATE_T *state,
+ const VCHIQ_SERVICE_PARAMS_T *params, int srvstate,
+ VCHIQ_INSTANCE_T instance)
+{
+ VCHIQ_SERVICE_T **pservice = NULL;
+ VCHIQ_SERVICE_T *service = NULL;
+ int i;
+
+ /* Prepare to use a previously unused service */
+ if (state->unused_service < VCHIQ_MAX_SERVICES)
+ {
+ pservice = &state->services[state->unused_service];
+ }
+
+ if (srvstate == VCHIQ_SRVSTATE_OPENING) {
+ for (i = 0; i < state->unused_service; i++) {
+ VCHIQ_SERVICE_T *srv = state->services[i];
+ if (!srv)
+ {
+ pservice = &state->services[i];
+ break;
+ }
+ if (srv->srvstate == VCHIQ_SRVSTATE_FREE) {
+ service = srv;
+ break;
+ }
+ }
+ } else {
+ for (i = (state->unused_service - 1); i >= 0; i--) {
+ VCHIQ_SERVICE_T *srv = state->services[i];
+ if (!srv)
+ pservice = &state->services[i];
+ else if (srv->srvstate == VCHIQ_SRVSTATE_FREE) {
+ service = srv;
+ } else if ((srv->public_fourcc == params->fourcc) &&
+ ((srv->instance != instance)
+ || (srv->base.callback != params->callback))) {
+ /* There is another server using this fourcc which doesn't match */
+ pservice = NULL;
+ service = NULL;
+ }
+ }
+ }
+
+ if (pservice && !service)
+ {
+ service = vcos_malloc(sizeof(VCHIQ_SERVICE_T), "VCHIQ service");
+ if (service)
+ {
+ service->srvstate = VCHIQ_SRVSTATE_FREE;
+ service->localport = (pservice - state->services);
+ vcos_event_create(&service->remove_event, "v.remove_event");
+ vcos_event_create(&service->bulk_remove_event, "v.bulk_remove_event");
+ vcos_mutex_create(&service->bulk_mutex, "v.bulk_mutex");
+ *pservice = service;
+ }
+ else
+ {
+ vcos_log_error("vchiq: Out of memory");
+ }
+ }
+
+ if (service) {
+ VCHIQ_SERVICE_QUOTA_T *service_quota =
+ &state->service_quotas[service->localport];
+ if (vcos_is_log_enabled( &vchiq_core_msg_log_category, VCOS_LOG_INFO)) {
+ vcos_log_impl( &vchiq_core_msg_log_category,
+ VCOS_LOG_INFO,
+ "%s Service %c%c%c%c SrcPort:%d",
+ ( srvstate == VCHIQ_SRVSTATE_OPENING )
+ ? "Open" : "Add",
+ VCHIQ_FOURCC_AS_4CHARS(params->fourcc),
+ service->localport );
+ }
+ service->state = state;
+ service->base.fourcc = params->fourcc;
+ service->base.callback = params->callback;
+ service->base.userdata = params->userdata;
+ service->version = params->version;
+ service->version_min = params->version_min;
+ vchiq_set_service_state(service, srvstate);
+ service->public_fourcc =
+ (srvstate ==
+ VCHIQ_SRVSTATE_OPENING) ? VCHIQ_FOURCC_INVALID : params->fourcc;
+ service->instance = instance;
+ service->remoteport = VCHIQ_PORT_FREE;
+ service->client_id = 0;
+ service->auto_close = 1;
+ service->service_use_count = 0;
+ init_bulk_queue(&service->bulk_tx);
+ init_bulk_queue(&service->bulk_rx);
+ service_quota->slot_quota = state->default_slot_quota;
+ if (service_quota->slot_use_count == 0)
+ service_quota->previous_tx_index =
+ SLOT_QUEUE_INDEX_FROM_POS(state->local_tx_pos) - 1;
+ memset(&service->stats, 0, sizeof(service->stats));
+ vcos_atomic_flags_create(&service->poll_flags);
+
+ /* Ensure the events are unsignalled */
+ while (vcos_event_try(&service->remove_event) == VCOS_SUCCESS)
+ continue;
+ while (vcos_event_try(&service_quota->quota_event) == VCOS_SUCCESS)
+ continue;
+
+ if (pservice == &state->services[state->unused_service])
+ state->unused_service++;
+ }
+
+ return service;
+}
+
+VCHIQ_STATUS_T
+vchiq_open_service_internal(VCHIQ_SERVICE_T *service, int client_id)
+{
+ VCHIQ_OPEN_PAYLOAD_T payload = {
+ service->base.fourcc,
+ client_id,
+ service->version,
+ service->version_min
+ };
+ VCHIQ_ELEMENT_T body = { &payload, sizeof(payload) };
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ service->client_id = client_id;
+ vchiq_use_service(&service->base);
+ status = queue_message(service->state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_OPEN, service->localport, 0),
+ &body, 1, sizeof(payload), 1);
+ if (status == VCHIQ_SUCCESS) {
+ if (vcos_event_wait(&service->remove_event) != VCOS_SUCCESS) {
+ status = VCHIQ_RETRY;
+ vchiq_release_service(&service->base);
+ } else if (service->srvstate != VCHIQ_SRVSTATE_OPEN) {
+ vcos_log_info("%d: osi - srvstate = %d", service->state->id, service->srvstate);
+ vcos_assert(service->srvstate == VCHIQ_SRVSTATE_CLOSEWAIT);
+ status = VCHIQ_ERROR;
+ VCHIQ_SERVICE_STATS_INC(service, error_count);
+ vchiq_release_service(&service->base);
+ }
+ }
+ return status;
+}
+
+/* Called by the slot handler */
+VCHIQ_STATUS_T
+vchiq_close_service_internal(VCHIQ_SERVICE_T *service, int close_recvd)
+{
+ VCHIQ_STATE_T *state = service->state;
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ vcos_log_trace("%d: csi:%d (%s)",
+ service->state->id, service->localport,
+ srvstate_names[service->srvstate]);
+
+ switch (service->srvstate)
+ {
+ case VCHIQ_SRVSTATE_OPENING:
+ if (close_recvd)
+ {
+ /* The open was rejected - tell the user */
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSEWAIT);
+ vcos_event_signal(&service->remove_event);
+ }
+ else
+ {
+ /* Shutdown mid-open - let the other side know */
+ status = queue_message(state, NULL,
+ VCHIQ_MAKE_MSG
+ (VCHIQ_MSG_CLOSE,
+ service->localport,
+ VCHIQ_MSG_DSTPORT(service->remoteport)),
+ NULL, 0, 0, 0);
+
+ if (status == VCHIQ_SUCCESS)
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSESENT);
+ }
+ break;
+
+ case VCHIQ_SRVSTATE_OPEN:
+ if (state->is_master)
+ {
+ /* Abort any outstanding bulk transfers */
+ vcos_mutex_lock(&service->bulk_mutex);
+ abort_outstanding_bulks(service, &service->bulk_tx);
+ abort_outstanding_bulks(service, &service->bulk_rx);
+ status = notify_bulks(service, &service->bulk_tx);
+ if (status == VCHIQ_SUCCESS)
+ status = notify_bulks(service, &service->bulk_rx);
+ vcos_mutex_unlock(&service->bulk_mutex);
+ }
+
+ if (status == VCHIQ_SUCCESS)
+ status = queue_message(state, NULL,
+ VCHIQ_MAKE_MSG
+ (VCHIQ_MSG_CLOSE,
+ service->localport,
+ VCHIQ_MSG_DSTPORT(service->remoteport)),
+ NULL, 0, 0, 0);
+
+ if (status == VCHIQ_SUCCESS)
+ {
+ if (close_recvd)
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSING);
+ else
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSESENT);
+ }
+ break;
+
+ case VCHIQ_SRVSTATE_CLOSESENT:
+ vcos_assert(close_recvd);
+
+ if (!state->is_master)
+ {
+ /* Abort any outstanding bulk transfers */
+ vcos_mutex_lock(&service->bulk_mutex);
+ abort_outstanding_bulks(service, &service->bulk_tx);
+ abort_outstanding_bulks(service, &service->bulk_rx);
+ status = notify_bulks(service, &service->bulk_tx);
+ if (status == VCHIQ_SUCCESS)
+ status = notify_bulks(service, &service->bulk_rx);
+ vcos_mutex_unlock(&service->bulk_mutex);
+ }
+
+ if (status == VCHIQ_SUCCESS)
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSING);
+ break;
+
+ case VCHIQ_SRVSTATE_CLOSING:
+ /* We may come here after a retry */
+ vcos_assert(!close_recvd);
+ break;
+
+ default:
+ vcos_log_error("vchiq_close_service_internal(%d) called in state %s",
+ close_recvd, srvstate_names[service->srvstate]);
+ vcos_assert(0);
+ break;
+ }
+
+ if (service->srvstate == VCHIQ_SRVSTATE_CLOSING)
+ {
+ /* Complete the close process */
+ vchiq_release_service(&service->base);
+
+ service->client_id = 0;
+
+ /* Now tell the client that the services is closed */
+ if (service->instance)
+ {
+ int oldstate = service->srvstate;
+
+ /* Change the service state now for the benefit of the callback */
+ vchiq_set_service_state(service,
+ ((service->public_fourcc == VCHIQ_FOURCC_INVALID) ||
+ !service->auto_close) ?
+ VCHIQ_SRVSTATE_CLOSEWAIT :
+ VCHIQ_SRVSTATE_LISTENING);
+
+ status = make_service_callback(service, VCHIQ_SERVICE_CLOSED, NULL, NULL);
+
+ if (status == VCHIQ_RETRY)
+ {
+ /* Restore the old state, to be retried later */
+ vchiq_set_service_state(service, oldstate);
+ }
+ else
+ {
+ if (status == VCHIQ_ERROR) {
+ /* Signal an error (fatal, since the other end will probably have closed) */
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_OPEN);
+ }
+ }
+ }
+
+ if (status != VCHIQ_RETRY)
+ {
+ if (service->srvstate == VCHIQ_SRVSTATE_CLOSING)
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_CLOSEWAIT);
+ vcos_event_signal(&service->remove_event);
+ }
+ }
+
+ return status;
+}
+
+/* Called from the application process upon process death */
+void
+vchiq_terminate_service_internal(VCHIQ_SERVICE_T *service)
+{
+ VCHIQ_STATE_T *state = service->state;
+
+ vcos_log_info("%d: tsi - (%d<->%d)", state->id, service->localport, service->remoteport);
+
+ /* Disconnect from the instance, to prevent any callbacks */
+ service->instance = NULL;
+
+ /* Mark the service for termination by the slot handler */
+ request_poll(state, service, VCHIQ_POLL_TERMINATE);
+}
+
+/* Called from the application process upon process death, and from
+ vchiq_remove_service */
+void
+vchiq_free_service_internal(VCHIQ_SERVICE_T *service)
+{
+ VCHIQ_STATE_T *state = service->state;
+ int slot_last = state->remote->slot_last;
+ int i;
+
+ vcos_log_info("%d: fsi - (%d)", state->id, service->localport);
+
+ vcos_mutex_lock(&state->mutex);
+
+ /* Release any claimed messages */
+ for (i = state->remote->slot_first; i <= slot_last; i++)
+ {
+ VCHIQ_SLOT_INFO_T *slot_info = SLOT_INFO_FROM_INDEX(state, i);
+ if (slot_info->release_count != slot_info->use_count)
+ {
+ char *data = (char *)SLOT_DATA_FROM_INDEX(state, i);
+ int pos, end;
+
+ end = VCHIQ_SLOT_SIZE;
+ if (data == state->rx_data)
+ {
+ /* This buffer is still being read from - stop at the current read position */
+ end = state->rx_pos & VCHIQ_SLOT_MASK;
+ }
+
+ pos = 0;
+
+ while (pos < end)
+ {
+ VCHIQ_HEADER_T *header = (VCHIQ_HEADER_T *)(data + pos);
+ int msgid = header->msgid;
+ int port = VCHIQ_MSG_DSTPORT(msgid);
+ if (port == service->localport)
+ {
+ if (msgid & VCHIQ_MSGID_CLAIMED)
+ {
+ header->msgid = msgid & ~VCHIQ_MSGID_CLAIMED;
+ vcos_log_info(" fsi - hdr %x", (unsigned int)header);
+ release_slot(state, slot_info);
+ }
+ }
+ pos += calc_stride(header->size);
+ }
+ }
+ }
+
+ vcos_assert(state->services[service->localport] == service);
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_FREE);
+ state->services[service->localport] = NULL;
+ vcos_free(service);
+ vcos_mutex_unlock(&state->mutex);
+}
+
+VCHIQ_STATUS_T
+vchiq_connect_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance)
+{
+ int i;
+
+ /* Find all services registered to this client and enable them. */
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (service && (service->instance == instance)) {
+ if (service->srvstate == VCHIQ_SRVSTATE_HIDDEN)
+ vchiq_set_service_state(service,
+ VCHIQ_SRVSTATE_LISTENING);
+ }
+ }
+
+ if (state->conn_state == VCHIQ_CONNSTATE_DISCONNECTED) {
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_CONNECT, 0, 0), NULL, 0,
+ 0, 1) == VCHIQ_RETRY)
+ return VCHIQ_RETRY;
+ vcos_event_wait(&state->connect);
+
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_CONNECTED);
+ }
+
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_shutdown_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance)
+{
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+ int i;
+
+ /* Find all services registered to this client and close them. */
+ for (i = 0; i < state->unused_service; i++)
+ {
+ VCHIQ_SERVICE_T *service = state->services[i];
+ if (service && (service->instance == instance) &&
+ ((service->srvstate == VCHIQ_SRVSTATE_OPEN) ||
+ (service->srvstate == VCHIQ_SRVSTATE_LISTENING)))
+ {
+ status = vchiq_remove_service(&service->base);
+ if (status != VCHIQ_SUCCESS)
+ break;
+ }
+ }
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_pause_internal(VCHIQ_STATE_T *state)
+{
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ switch (state->conn_state)
+ {
+ case VCHIQ_CONNSTATE_CONNECTED:
+ /* Request a pause */
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_PAUSING);
+ request_poll(state, NULL, 0);
+ break;
+ case VCHIQ_CONNSTATE_PAUSED:
+ break;
+ default:
+ status = VCHIQ_ERROR;
+ VCHIQ_STATS_INC(state, error_count);
+ break;
+ }
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_resume_internal(VCHIQ_STATE_T *state)
+{
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ if (state->conn_state == VCHIQ_CONNSTATE_PAUSED)
+ {
+ vchiq_set_conn_state(state, VCHIQ_CONNSTATE_RESUMING);
+ request_poll(state, NULL, 0);
+ }
+ else
+ {
+ status = VCHIQ_ERROR;
+ VCHIQ_STATS_INC(state, error_count);
+ }
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_close_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ /* Unregister the service */
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *) handle;
+ VCHIQ_STATUS_T status = VCHIQ_ERROR;
+
+ if (service == NULL)
+ return VCHIQ_ERROR;
+
+ vcos_log_info("%d: close_service:%d", service->state->id, service->localport);
+
+ if (service->public_fourcc != VCHIQ_FOURCC_INVALID)
+ {
+ if (service->srvstate == VCHIQ_SRVSTATE_CLOSEWAIT)
+ {
+ /* This is a non-auto-close server */
+ vchiq_set_service_state(service, VCHIQ_SRVSTATE_LISTENING);
+ status = VCHIQ_SUCCESS;
+ }
+ }
+ else
+ {
+ /* For clients, make it an alias of vchiq_remove_service */
+ status = vchiq_remove_service(handle);
+ }
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_remove_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ /* Unregister the service */
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *) handle;
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ if (service == NULL)
+ return VCHIQ_ERROR;
+
+ vcos_log_info("%d: remove_service:%d", service->state->id, service->localport);
+
+ switch (service->srvstate)
+ {
+ case VCHIQ_SRVSTATE_OPENING:
+ case VCHIQ_SRVSTATE_OPEN:
+ /* Mark the service for termination by the slot handler */
+ request_poll(service->state, service, VCHIQ_POLL_TERMINATE);
+
+ /* Drop through... */
+ case VCHIQ_SRVSTATE_CLOSESENT:
+ case VCHIQ_SRVSTATE_CLOSING:
+ while ((service->srvstate != VCHIQ_SRVSTATE_CLOSEWAIT) &&
+ (service->srvstate != VCHIQ_SRVSTATE_LISTENING))
+ {
+ if (vcos_event_wait(&service->remove_event) != VCOS_SUCCESS) {
+ status = VCHIQ_RETRY;
+ break;
+ }
+ }
+ break;
+
+ default:
+ break;
+ }
+
+ if (status == VCHIQ_SUCCESS) {
+ if (service->srvstate == VCHIQ_SRVSTATE_OPEN)
+ status = VCHIQ_ERROR;
+ else
+ {
+ service->instance = NULL;
+ vchiq_free_service_internal(service);
+ }
+ }
+
+ return status;
+}
+
+
+VCHIQ_STATUS_T
+vchiq_bulk_transfer(VCHIQ_SERVICE_T *service,
+ VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata,
+ VCHIQ_BULK_MODE_T mode, VCHIQ_BULK_DIR_T dir)
+{
+ VCHIQ_BULK_QUEUE_T *queue = (dir == VCHIQ_BULK_TRANSMIT) ?
+ &service->bulk_tx : &service->bulk_rx;
+ VCHIQ_BULK_T *bulk;
+ VCHIQ_STATE_T *state;
+ BULK_WAITER_T bulk_waiter;
+ const char dir_char = (dir == VCHIQ_BULK_TRANSMIT) ? 't' : 'r';
+ const int dir_msgtype = (dir == VCHIQ_BULK_TRANSMIT) ? VCHIQ_MSG_BULK_TX : VCHIQ_MSG_BULK_RX;
+ VCHIQ_STATUS_T status = VCHIQ_ERROR;
+
+ if ((service == NULL) ||
+ ((memhandle == VCHI_MEM_HANDLE_INVALID) && (offset == NULL)))
+ return VCHIQ_ERROR;
+
+ state = service->state;
+
+ if (service->srvstate != VCHIQ_SRVSTATE_OPEN)
+ return VCHIQ_ERROR; /* Must be connected */
+
+ if (vcos_mutex_lock(&service->bulk_mutex) != VCOS_SUCCESS)
+ return VCHIQ_RETRY;
+
+ if (queue->local_insert == queue->remove + VCHIQ_NUM_SERVICE_BULKS)
+ {
+ VCHIQ_SERVICE_STATS_INC(service, bulk_stalls);
+ do {
+ vcos_mutex_unlock(&service->bulk_mutex);
+ if (vcos_event_wait(&service->bulk_remove_event) != VCOS_SUCCESS)
+ return VCHIQ_RETRY;
+ if (vcos_mutex_lock(&service->bulk_mutex) != VCOS_SUCCESS)
+ return VCHIQ_RETRY;
+ } while (queue->local_insert == queue->remove + VCHIQ_NUM_SERVICE_BULKS);
+ }
+
+ bulk = &queue->bulks[BULK_INDEX(queue->local_insert)];
+
+ if (mode == VCHIQ_BULK_MODE_BLOCKING)
+ {
+ vcos_event_create(&bulk_waiter.event, "bulk_waiter");
+ bulk_waiter.actual = 0;
+ userdata = &bulk_waiter;
+ }
+
+ bulk->mode = mode;
+ bulk->dir = dir;
+ bulk->userdata = userdata;
+ bulk->size = size;
+ bulk->actual = VCHIQ_BULK_ACTUAL_ABORTED;
+
+ if (vchiq_prepare_bulk_data(bulk, memhandle, offset, size, dir) != VCHIQ_SUCCESS)
+ {
+ goto error_exit;
+ }
+
+ vcos_log_info("%d: bt (%d->%d) %cx %x@%x %x", state->id,
+ service->localport, service->remoteport, dir_char,
+ size, (unsigned int)bulk->data, (unsigned int)userdata);
+
+ if (state->is_master)
+ {
+ queue->local_insert++;
+ if (resolve_bulks(service, queue))
+ request_poll(state, service, (dir == VCHIQ_BULK_TRANSMIT) ?
+ VCHIQ_POLL_TXNOTIFY : VCHIQ_POLL_RXNOTIFY);
+ }
+ else
+ {
+ int payload[2] = { (int)bulk->data, bulk->size };
+ VCHIQ_ELEMENT_T element = { payload, sizeof(payload) };
+
+ if (queue_message(state, NULL,
+ VCHIQ_MAKE_MSG(dir_msgtype,
+ service->localport, service->remoteport),
+ &element, 1, sizeof(payload), 1) != VCHIQ_SUCCESS)
+ {
+ vchiq_complete_bulk(bulk);
+ goto error_exit;
+ }
+ queue->local_insert++;
+ queue->remote_insert++;
+ }
+
+ vcos_mutex_unlock(&service->bulk_mutex);
+
+ vcos_log_trace("%d: bt:%d %cx li=%x ri=%x p=%x", state->id,
+ service->localport, dir_char,
+ queue->local_insert, queue->remote_insert, queue->process);
+
+ status = VCHIQ_SUCCESS;
+
+ if (mode == VCHIQ_BULK_MODE_BLOCKING)
+ {
+ if (vcos_event_wait(&bulk_waiter.event) != VCOS_SUCCESS)
+ {
+ vcos_log_info("bulk wait interrupted");
+ /* Stop notify_bulks signalling a non-existent waiter */
+ bulk->userdata = NULL;
+ status = VCHIQ_ERROR;
+ }
+ else if (bulk_waiter.actual == VCHIQ_BULK_ACTUAL_ABORTED)
+ status = VCHIQ_ERROR;
+
+ vcos_event_delete(&bulk_waiter.event);
+ }
+
+ return status;
+
+error_exit:
+ if (mode == VCHIQ_BULK_MODE_BLOCKING)
+ vcos_event_delete(&bulk_waiter.event);
+ vcos_mutex_unlock(&service->bulk_mutex);
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_transmit(VCHIQ_SERVICE_HANDLE_T handle,
+ const void *data, int size, void *userdata)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ VCHI_MEM_HANDLE_INVALID, (void *)data, size, userdata,
+ VCHIQ_BULK_MODE_CALLBACK, VCHIQ_BULK_TRANSMIT);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_receive(VCHIQ_SERVICE_HANDLE_T handle, void *data, int size,
+ void *userdata)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ VCHI_MEM_HANDLE_INVALID, data, size, userdata,
+ VCHIQ_BULK_MODE_CALLBACK, VCHIQ_BULK_RECEIVE);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle, const void *offset, int size, void *userdata)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ memhandle, (void *)offset, size, userdata,
+ VCHIQ_BULK_MODE_CALLBACK, VCHIQ_BULK_TRANSMIT);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ memhandle, offset, size, userdata,
+ VCHIQ_BULK_MODE_CALLBACK, VCHIQ_BULK_RECEIVE);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_transmit(VCHIQ_SERVICE_HANDLE_T handle, const void *data, int size,
+ void *userdata, VCHIQ_BULK_MODE_T mode)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ VCHI_MEM_HANDLE_INVALID, (void *)data, size, userdata,
+ mode, VCHIQ_BULK_TRANSMIT);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_receive(VCHIQ_SERVICE_HANDLE_T handle, void *data, int size,
+ void *userdata, VCHIQ_BULK_MODE_T mode)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ VCHI_MEM_HANDLE_INVALID, data, size, userdata,
+ mode, VCHIQ_BULK_RECEIVE);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle, const void *offset, int size, void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ memhandle, (void *)offset, size, userdata,
+ mode, VCHIQ_BULK_TRANSMIT);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ return vchiq_bulk_transfer((VCHIQ_SERVICE_T *)handle,
+ memhandle, offset, size, userdata,
+ mode, VCHIQ_BULK_RECEIVE);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_message(VCHIQ_SERVICE_HANDLE_T handle,
+ const VCHIQ_ELEMENT_T *elements, int count)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *) handle;
+
+ unsigned int size = 0;
+ unsigned int i;
+
+ if ((service == NULL) ||
+ (service->srvstate != VCHIQ_SRVSTATE_OPEN))
+ return VCHIQ_ERROR;
+
+ for (i = 0; i < (unsigned int)count; i++)
+ {
+ if (elements[i].size)
+ {
+ if (elements[i].data == NULL)
+ {
+ VCHIQ_SERVICE_STATS_INC(service, error_count);
+ return VCHIQ_ERROR;
+ }
+ size += elements[i].size;
+ }
+ }
+
+ if (size > VCHIQ_MAX_MSG_SIZE)
+ {
+ VCHIQ_SERVICE_STATS_INC(service, error_count);
+ return VCHIQ_ERROR;
+ }
+
+ return queue_message(service->state, service,
+ VCHIQ_MAKE_MSG(VCHIQ_MSG_DATA, service->localport,
+ service->remoteport), elements, count, size, 1);
+}
+
+void
+vchiq_release_message(VCHIQ_SERVICE_HANDLE_T handle, VCHIQ_HEADER_T *header)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_STATE_T *state;
+ int slot_index;
+ int msgid;
+
+ if (service == NULL)
+ return;
+
+ state = service->state;
+
+ slot_index = SLOT_INDEX_FROM_DATA(state, (void *)header);
+
+ if ((slot_index >= state->remote->slot_first) &&
+ (slot_index <= state->remote->slot_last) &&
+ ((msgid = header->msgid) & VCHIQ_MSGID_CLAIMED))
+ {
+ VCHIQ_SLOT_INFO_T *slot_info = SLOT_INFO_FROM_INDEX(state, slot_index);
+
+ /* Rewrite the message header to prevent a double release */
+ header->msgid = msgid & ~VCHIQ_MSGID_CLAIMED;
+
+ release_slot(state, slot_info);
+ }
+}
+
+int
+vchiq_get_client_id(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ return service ? service->client_id : 0;
+}
+
+VCHIQ_STATUS_T
+vchiq_get_config(VCHIQ_INSTANCE_T instance,
+ int config_size, VCHIQ_CONFIG_T *pconfig)
+{
+ VCHIQ_CONFIG_T config;
+
+ vcos_unused(instance);
+
+ config.max_msg_size = VCHIQ_MAX_MSG_SIZE;
+ config.bulk_threshold = VCHIQ_MAX_MSG_SIZE;
+ config.max_outstanding_bulks = VCHIQ_NUM_SERVICE_BULKS;
+ config.max_services = VCHIQ_MAX_SERVICES;
+ config.version = VCHIQ_VERSION;
+ config.version_min = VCHIQ_VERSION_MIN;
+
+ if (config_size > sizeof(VCHIQ_CONFIG_T))
+ return VCHIQ_ERROR;
+
+ memcpy(pconfig, &config, vcos_min(config_size, sizeof(VCHIQ_CONFIG_T)));
+
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_set_service_option(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHIQ_SERVICE_OPTION_T option, int value)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_STATUS_T status = VCHIQ_ERROR;
+
+ if (service)
+ {
+ switch (option)
+ {
+ case VCHIQ_SERVICE_OPTION_AUTOCLOSE:
+ service->auto_close = value;
+ status = VCHIQ_SUCCESS;
+ break;
+
+ default:
+ break;
+ }
+ }
+
+ return status;
+}
+
+void
+vchiq_dump_shared_state(void *dump_context, VCHIQ_STATE_T *state,
+ VCHIQ_SHARED_STATE_T *shared, const char *label)
+{
+ static const char *const debug_names[] =
+ {
+ "<entries>",
+ "SLOT_HANDLER_COUNT",
+ "SLOT_HANDLER_LINE",
+ "PARSE_LINE",
+ "PARSE_HEADER",
+ "PARSE_MSGID",
+ "AWAIT_COMPLETION_LINE",
+ "DEQUEUE_MESSAGE_LINE",
+ "SERVICE_CALLBACK_LINE",
+ "MSG_QUEUE_FULL_COUNT",
+ "COMPLETION_QUEUE_FULL_COUNT"
+ };
+ int i;
+
+ char buf[80];
+ int len;
+ len = vcos_snprintf(buf, sizeof(buf),
+ " %s: slots %d-%d tx_pos=%x recycle=%x",
+ label, shared->slot_first, shared->slot_last,
+ shared->tx_pos, shared->slot_queue_recycle);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Slots claimed:");
+ vchiq_dump(dump_context, buf, len + 1);
+
+ for (i = shared->slot_first; i <= shared->slot_last; i++)
+ {
+ VCHIQ_SLOT_INFO_T slot_info = *SLOT_INFO_FROM_INDEX(state, i);
+ if (slot_info.use_count != slot_info.release_count)
+ {
+ len = vcos_snprintf(buf, sizeof(buf),
+ " %d: %d/%d", i, slot_info.use_count, slot_info.release_count);
+ vchiq_dump(dump_context, buf, len + 1);
+ }
+ }
+
+ for (i = 1; i < shared->debug[DEBUG_ENTRIES]; i++)
+ {
+ len = vcos_snprintf(buf, sizeof(buf), " DEBUG: %s = %d(%x)",
+ debug_names[i], shared->debug[i], shared->debug[i]);
+ vchiq_dump(dump_context, buf, len + 1);
+ }
+}
+
+void
+vchiq_dump_state(void *dump_context, VCHIQ_STATE_T *state)
+{
+ char buf[80];
+ int len;
+ int i;
+
+ len = vcos_snprintf(buf, sizeof(buf), "State %d: %s", state->id,
+ conn_state_names[state->conn_state]);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " tx_pos=%x(@%x), rx_pos=%x(@%x)",
+ state->id, state->local->tx_pos,
+ (uint32_t)state->tx_data + (state->local_tx_pos & VCHIQ_SLOT_MASK),
+ state->rx_pos,
+ (uint32_t)state->rx_data + (state->rx_pos & VCHIQ_SLOT_MASK));
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Version: %d (min %d)",
+ VCHIQ_VERSION, VCHIQ_VERSION_MIN);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ if (VCHIQ_ENABLE_STATS)
+ {
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Stats: ctrl_tx_count=%d, ctrl_rx_count=%d, error_count=%d",
+ state->stats.ctrl_tx_count, state->stats.ctrl_rx_count,
+ state->stats.slot_stalls);
+ vchiq_dump(dump_context, buf, len + 1);
+ }
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Slots: %d available, %d recyclable, %d stalls",
+ state->slot_queue_available - SLOT_QUEUE_INDEX_FROM_POS(state->local_tx_pos),
+ state->local->slot_queue_recycle - state->slot_queue_available,
+ state->stats.slot_stalls);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ vchiq_dump_platform_state(dump_context);
+
+ vchiq_dump_shared_state(dump_context, state, state->local, "Local");
+ vchiq_dump_shared_state(dump_context, state, state->remote, "Remote");
+
+ vchiq_dump_platform_instances(dump_context);
+
+ for (i = 0; i < state->unused_service; i++) {
+ VCHIQ_SERVICE_T *service = state->services[i];
+
+ if (service && (service->srvstate != VCHIQ_SRVSTATE_FREE))
+ vchiq_dump_service_state(dump_context, service);
+ }
+}
+
+void
+vchiq_dump_service_state(void *dump_context, VCHIQ_SERVICE_T *service)
+{
+ char buf[80];
+ int len;
+
+ len = vcos_snprintf(buf, sizeof(buf), "Service %d: %s",
+ service->localport, srvstate_names[service->srvstate]);
+
+ if (service->srvstate != VCHIQ_SRVSTATE_FREE)
+ {
+ char remoteport[30];
+ VCHIQ_SERVICE_QUOTA_T *service_quota =
+ &service->state->service_quotas[service->localport];
+ int fourcc = service->base.fourcc;
+ if (service->remoteport != VCHIQ_PORT_FREE)
+ {
+ int len2 = vcos_snprintf(remoteport, sizeof(remoteport), "%d",
+ service->remoteport);
+ if (service->public_fourcc != VCHIQ_FOURCC_INVALID)
+ vcos_snprintf(remoteport + len2, sizeof(remoteport) - len2,
+ " (client %x)", service->client_id);
+ }
+ else
+ vcos_strcpy(remoteport, "n/a");
+
+ len += vcos_snprintf(buf + len, sizeof(buf) - len,
+ " '%c%c%c%c' remote %s (slot use %d/%d)",
+ VCHIQ_FOURCC_AS_4CHARS(fourcc),
+ remoteport,
+ service_quota->slot_use_count,
+ service_quota->slot_quota);
+
+ if (VCHIQ_ENABLE_STATS)
+ {
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Ctrl: tx_count=%d, tx_bytes=%" PRIu64 ", rx_count=%d, rx_bytes=%" PRIu64,
+ service->stats.ctrl_tx_count, service->stats.ctrl_tx_bytes,
+ service->stats.ctrl_rx_count, service->stats.ctrl_rx_bytes);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " Bulk: tx_count=%d, tx_bytes=%" PRIu64 ", rx_count=%d, rx_bytes=%" PRIu64,
+ service->stats.bulk_tx_count, service->stats.bulk_tx_bytes,
+ service->stats.bulk_rx_count, service->stats.bulk_rx_bytes);
+ vchiq_dump(dump_context, buf, len + 1);
+
+ len = vcos_snprintf(buf, sizeof(buf),
+ " %d quota stalls, %d slot stalls, %d bulk stalls, %d aborted, %d errors",
+ service->stats.quota_stalls, service->stats.slot_stalls,
+ service->stats.bulk_stalls, service->stats.bulk_aborted_count,
+ service->stats.error_count);
+ }
+ }
+
+ vchiq_dump(dump_context, buf, len + 1);
+
+ vchiq_dump_platform_service_state(dump_context, service);
+}
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_core.h
@@ -0,0 +1,480 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_CORE_H
+#define VCHIQ_CORE_H
+
+#include "vchiq_cfg.h"
+
+#include "vchiq.h"
+
+#define IS_POW2(x) (x && ((x & (x - 1)) == 0))
+
+/* Ensure that the slot size and maximum number of slots are powers of 2 */
+vcos_static_assert(IS_POW2(VCHIQ_SLOT_SIZE));
+vcos_static_assert(IS_POW2(VCHIQ_MAX_SLOTS));
+vcos_static_assert(IS_POW2(VCHIQ_MAX_SLOTS_PER_SIDE));
+
+#define VCHIQ_SLOT_MASK (VCHIQ_SLOT_SIZE - 1)
+#define VCHIQ_SLOT_QUEUE_MASK (VCHIQ_MAX_SLOTS_PER_SIDE - 1)
+#define VCHIQ_SLOT_ZERO_SLOTS ((sizeof(VCHIQ_SLOT_ZERO_T) + \
+ VCHIQ_SLOT_SIZE - 1) / VCHIQ_SLOT_SIZE)
+
+#define VCHIQ_MSG_PADDING 0 // -
+#define VCHIQ_MSG_CONNECT 1 // -
+#define VCHIQ_MSG_OPEN 2 // + (srcport, -), fourcc, client_id
+#define VCHIQ_MSG_OPENACK 3 // + (srcport, dstport)
+#define VCHIQ_MSG_CLOSE 4 // + (srcport, dstport)
+#define VCHIQ_MSG_DATA 5 // + (srcport, dstport)
+#define VCHIQ_MSG_BULK_RX 6 // + (srcport, dstport), data, size
+#define VCHIQ_MSG_BULK_TX 7 // + (srcport, dstport), data, size
+#define VCHIQ_MSG_BULK_RX_DONE 8 // + (srcport, dstport), actual
+#define VCHIQ_MSG_BULK_TX_DONE 9 // + (srcport, dstport), actual
+#define VCHIQ_MSG_PAUSE 10 // -
+#define VCHIQ_MSG_RESUME 11 // -
+
+#define VCHIQ_PORT_MAX (VCHIQ_MAX_SERVICES - 1)
+#define VCHIQ_PORT_FREE 0x1000
+#define VCHIQ_PORT_IS_VALID(port) (port < VCHIQ_PORT_FREE)
+#define VCHIQ_MAKE_MSG(type,srcport,dstport) ((type<<24) | (srcport<<12) | (dstport<<0))
+#define VCHIQ_MSG_TYPE(msgid) ((unsigned int)msgid >> 24)
+#define VCHIQ_MSG_SRCPORT(msgid) (unsigned short)(((unsigned int)msgid >> 12) & 0xfff)
+#define VCHIQ_MSG_DSTPORT(msgid) ((unsigned short)msgid & 0xfff)
+
+#define VCHIQ_FOURCC_AS_4CHARS(fourcc) \
+ ((fourcc) >> 24) & 0xff, \
+ ((fourcc) >> 16) & 0xff, \
+ ((fourcc) >> 8) & 0xff, \
+ ((fourcc) ) & 0xff
+
+/* Ensure the fields are wide enough */
+vcos_static_assert(VCHIQ_MSG_SRCPORT(VCHIQ_MAKE_MSG(0,0,VCHIQ_PORT_MAX)) == 0);
+vcos_static_assert(VCHIQ_MSG_TYPE(VCHIQ_MAKE_MSG(0,VCHIQ_PORT_MAX,0)) == 0);
+vcos_static_assert((unsigned int)VCHIQ_PORT_MAX < (unsigned int)VCHIQ_PORT_FREE);
+
+#define VCHIQ_MSGID_PADDING VCHIQ_MAKE_MSG(VCHIQ_MSG_PADDING,0,0)
+#define VCHIQ_MSGID_CLAIMED 0x40000000
+
+#define VCHIQ_FOURCC_INVALID 0x00000000
+#define VCHIQ_FOURCC_IS_LEGAL(fourcc) (fourcc != VCHIQ_FOURCC_INVALID)
+
+#define VCHIQ_BULK_ACTUAL_ABORTED -1
+
+typedef uint32_t BITSET_T;
+
+vcos_static_assert((sizeof(BITSET_T) * 8) == 32);
+
+#define BITSET_SIZE(b) ((b + 31) >> 5)
+#define BITSET_WORD(b) (b >> 5)
+#define BITSET_BIT(b) (1 << (b & 31))
+#define BITSET_ZERO(bs) memset(bs, 0, sizeof(bs))
+#define BITSET_IS_SET(bs, b) (bs[BITSET_WORD(b)] & BITSET_BIT(b))
+#define BITSET_SET(bs, b) (bs[BITSET_WORD(b)] |= BITSET_BIT(b))
+#define BITSET_CLR(bs, b) (bs[BITSET_WORD(b)] &= ~BITSET_BIT(b))
+
+#if VCHIQ_ENABLE_STATS
+#define VCHIQ_STATS_INC(state, stat) (state->stats. stat ++)
+#define VCHIQ_SERVICE_STATS_INC(service, stat) (service->stats. stat ++)
+#define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) (service->stats. stat += addend)
+#else
+#define VCHIQ_STATS_INC(state, stat) ((void)0)
+#define VCHIQ_SERVICE_STATS_INC(service, stat) ((void)0)
+#define VCHIQ_SERVICE_STATS_ADD(service, stat, addend) ((void)0)
+#endif
+
+enum
+{
+ DEBUG_ENTRIES,
+#if VCHIQ_ENABLE_DEBUG
+ DEBUG_SLOT_HANDLER_COUNT,
+ DEBUG_SLOT_HANDLER_LINE,
+ DEBUG_PARSE_LINE,
+ DEBUG_PARSE_HEADER,
+ DEBUG_PARSE_MSGID,
+ DEBUG_AWAIT_COMPLETION_LINE,
+ DEBUG_DEQUEUE_MESSAGE_LINE,
+ DEBUG_SERVICE_CALLBACK_LINE,
+ DEBUG_MSG_QUEUE_FULL_COUNT,
+ DEBUG_COMPLETION_QUEUE_FULL_COUNT,
+#endif
+ DEBUG_MAX
+};
+
+#if VCHIQ_ENABLE_DEBUG
+
+#define DEBUG_INITIALISE(local) volatile int *debug_ptr = (local)->debug;
+#define DEBUG_TRACE(d) debug_ptr[DEBUG_ ## d] = __LINE__
+#define DEBUG_VALUE(d,v) debug_ptr[DEBUG_ ## d] = (v)
+#define DEBUG_COUNT(d) debug_ptr[DEBUG_ ## d]++
+
+#else /* VCHIQ_ENABLE_DEBUG */
+
+#define DEBUG_INITIALISE(local)
+#define DEBUG_TRACE(d)
+#define DEBUG_VALUE(d,v)
+#define DEBUG_COUNT(d)
+
+#endif /* VCHIQ_ENABLE_DEBUG */
+
+typedef enum
+{
+ VCHIQ_CONNSTATE_DISCONNECTED,
+ VCHIQ_CONNSTATE_CONNECTED,
+ VCHIQ_CONNSTATE_PAUSING,
+ VCHIQ_CONNSTATE_PAUSE_SENT,
+ VCHIQ_CONNSTATE_PAUSED,
+ VCHIQ_CONNSTATE_RESUMING
+} VCHIQ_CONNSTATE_T;
+
+enum
+{
+ VCHIQ_SRVSTATE_FREE,
+ VCHIQ_SRVSTATE_HIDDEN,
+ VCHIQ_SRVSTATE_LISTENING,
+ VCHIQ_SRVSTATE_OPENING,
+ VCHIQ_SRVSTATE_OPEN,
+ VCHIQ_SRVSTATE_CLOSESENT,
+ VCHIQ_SRVSTATE_CLOSING,
+ VCHIQ_SRVSTATE_CLOSEWAIT
+};
+
+enum
+{
+ VCHIQ_POLL_TERMINATE,
+ VCHIQ_POLL_TXNOTIFY,
+ VCHIQ_POLL_RXNOTIFY,
+ VCHIQ_POLL_COUNT
+};
+
+typedef enum
+{
+ VCHIQ_BULK_TRANSMIT,
+ VCHIQ_BULK_RECEIVE
+} VCHIQ_BULK_DIR_T;
+
+typedef struct vchiq_bulk_struct {
+ short mode;
+ short dir;
+ void *userdata;
+ VCHI_MEM_HANDLE_T handle;
+ void *data;
+ int size;
+ void *remote_data;
+ int remote_size;
+ int actual;
+} VCHIQ_BULK_T;
+
+typedef struct vchiq_bulk_queue_struct {
+ int local_insert; /* Where to insert the next local bulk */
+ int remote_insert; /* Where to insert the next remote bulk (master) */
+ int process; /* Bulk to transfer next */
+ int remote_notify; /* Bulk to notify the remote client of next (master) */
+ int remove; /* Bulk to notify the local client of, and remove, next */
+ VCHIQ_BULK_T bulks[VCHIQ_NUM_SERVICE_BULKS];
+} VCHIQ_BULK_QUEUE_T;
+
+typedef struct remote_event_struct {
+ volatile int armed;
+ volatile int fired;
+ VCOS_EVENT_T * event;
+} REMOTE_EVENT_T;
+
+typedef struct vchiq_state_struct VCHIQ_STATE_T;
+
+typedef struct vchiq_slot_struct {
+ char data[VCHIQ_SLOT_SIZE];
+} VCHIQ_SLOT_T;
+
+typedef struct vchiq_slot_info_struct {
+ /* Use two counters rather than one to avoid the need for a mutex. */
+ volatile short use_count;
+ volatile short release_count;
+} VCHIQ_SLOT_INFO_T;
+
+typedef struct vchiq_service_struct {
+ VCHIQ_SERVICE_BASE_T base;
+ volatile int srvstate;
+ unsigned int localport;
+ unsigned int remoteport;
+ int public_fourcc;
+ int client_id;
+ int auto_close;
+ VCOS_ATOMIC_FLAGS_T poll_flags;
+ short version;
+ short version_min;
+
+ VCHIQ_STATE_T *state;
+ VCHIQ_INSTANCE_T instance;
+
+ int service_use_count;
+
+ VCHIQ_BULK_QUEUE_T bulk_tx;
+ VCHIQ_BULK_QUEUE_T bulk_rx;
+
+ VCOS_EVENT_T remove_event;
+ VCOS_EVENT_T bulk_remove_event;
+ VCOS_MUTEX_T bulk_mutex;
+
+ struct service_stats_struct
+ {
+ int quota_stalls;
+ int slot_stalls;
+ int bulk_stalls;
+ int error_count;
+ int ctrl_tx_count;
+ int ctrl_rx_count;
+ int bulk_tx_count;
+ int bulk_rx_count;
+ int bulk_aborted_count;
+ uint64_t ctrl_tx_bytes;
+ uint64_t ctrl_rx_bytes;
+ uint64_t bulk_tx_bytes;
+ uint64_t bulk_rx_bytes;
+ } stats;
+} VCHIQ_SERVICE_T;
+
+/* The quota information is outside VCHIQ_SERVICE_T so that it can be
+ statically allocated, since for accounting reasons a service's slot
+ usage is carried over between users of the same port number.
+ */
+typedef struct vchiq_service_quota_struct {
+ int slot_quota;
+ int slot_use_count;
+ VCOS_EVENT_T quota_event;
+ int previous_tx_index;
+} VCHIQ_SERVICE_QUOTA_T;
+
+typedef struct vchiq_shared_state_struct {
+
+ /* A non-zero value here indicates that the content is valid. */
+ int initialised;
+
+ /* The first and last (inclusive) slots allocated to the owner. */
+ int slot_first;
+ int slot_last;
+
+ /* Signalling this event indicates that owner's slot handler thread should
+ run. */
+ REMOTE_EVENT_T trigger;
+
+ /* Indicates the byte position within the stream where the next message
+ will be written. The least significant bits are an index into the slot.
+ The next bits are the index of the slot in slot_queue. */
+ volatile int tx_pos;
+
+ /* This event should be signalled when a slot is recycled. */
+ REMOTE_EVENT_T recycle;
+
+ /* The slot_queue index where the next recycled slot will be written. */
+ volatile int slot_queue_recycle;
+
+ /* A circular buffer of slot indexes. */
+ int slot_queue[VCHIQ_MAX_SLOTS_PER_SIDE];
+
+ /* Debugging state */
+ volatile int debug[DEBUG_MAX];
+} VCHIQ_SHARED_STATE_T;
+
+typedef struct vchiq_slot_zero_struct {
+ int magic;
+ short version;
+ short version_min;
+ int slot_zero_size;
+ int slot_size;
+ int max_slots;
+ int max_slots_per_side;
+ int platform_data[2];
+ VCHIQ_SHARED_STATE_T master;
+ VCHIQ_SHARED_STATE_T slave;
+ VCHIQ_SLOT_INFO_T slots[VCHIQ_MAX_SLOTS];
+} VCHIQ_SLOT_ZERO_T;
+
+struct vchiq_state_struct {
+ int id;
+ int initialised;
+ VCHIQ_CONNSTATE_T conn_state;
+ int is_master;
+
+ VCHIQ_SHARED_STATE_T *local;
+ VCHIQ_SHARED_STATE_T *remote;
+ VCHIQ_SLOT_T *slot_data;
+
+ int default_slot_quota;
+
+ VCOS_EVENT_T connect; // event indicating connect message received
+ VCOS_MUTEX_T mutex; // mutex protecting services
+ VCHIQ_INSTANCE_T *instance;
+
+ VCOS_THREAD_T slot_handler_thread; // processes incoming messages
+ VCOS_THREAD_T recycle_thread; // processes recycled slots
+ VCOS_THREAD_T lp_thread; // processes low priority messages (eg suspend)
+
+ /* Local implementation of the trigger remote event */
+ VCOS_EVENT_T trigger_event;
+
+ /* Local implementation of the recycle remote event */
+ VCOS_EVENT_T recycle_event;
+
+ VCOS_EVENT_T lp_evt;
+
+ char *tx_data;
+ char *rx_data;
+ VCHIQ_SLOT_INFO_T *rx_info;
+
+ VCOS_MUTEX_T slot_mutex;
+
+ VCOS_MUTEX_T recycle_mutex;
+
+ VCOS_MUTEX_T suspend_resume_mutex;
+ VCOS_MUTEX_T use_count_mutex;
+
+ /* Global use count for videocore.
+ * This is equal to the sum of the use counts for all services. When this hits
+ * zero the videocore suspend procedure will be initiated. */
+ int videocore_use_count;
+
+ /* Flag to indicate whether videocore is currently suspended */
+ int videocore_suspended;
+
+ /* Indicates the byte position within the stream from where the next message
+ will be read. The least significant bits are an index into the slot.
+ The next bits are the index of the slot in remote->slot_queue. */
+ int rx_pos;
+
+ /* A cached copy of local->tx_pos. Only write to local->tx_pos, and read
+ from remote->tx_pos. */
+ int local_tx_pos;
+
+ /* The slot_queue index of the slot to become available next. */
+ int slot_queue_available;
+
+ /* A flag to indicate if any poll has been requested */
+ int poll_needed;
+
+ /* An array of bit sets indicating which services must be polled. */
+ VCOS_ATOMIC_FLAGS_T poll_services[BITSET_SIZE(VCHIQ_MAX_SERVICES)];
+
+ /* The number of the first unused service */
+ int unused_service;
+
+ /* Signalled when a free slot becomes available. */
+ VCOS_EVENT_T slot_available_event;
+
+ VCOS_EVENT_T slot_remove_event;
+
+ struct state_stats_struct
+ {
+ int slot_stalls;
+ int ctrl_tx_count;
+ int ctrl_rx_count;
+ int error_count;
+ } stats;
+
+ VCHIQ_SERVICE_T *services[VCHIQ_MAX_SERVICES];
+ VCHIQ_SERVICE_QUOTA_T service_quotas[VCHIQ_MAX_SERVICES];
+ VCHIQ_SLOT_INFO_T slot_info[VCHIQ_MAX_SLOTS];
+};
+
+extern VCHIQ_SLOT_ZERO_T *
+vchiq_init_slots(void *mem_base, int mem_size);
+
+extern VCHIQ_STATUS_T
+vchiq_init_state(VCHIQ_STATE_T *state, VCHIQ_SLOT_ZERO_T *slot_zero, int is_master);
+
+extern VCHIQ_STATUS_T
+vchiq_connect_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance);
+
+extern VCHIQ_SERVICE_T *
+vchiq_add_service_internal(VCHIQ_STATE_T *state,
+ const VCHIQ_SERVICE_PARAMS_T *params, int srvstate,
+ VCHIQ_INSTANCE_T instance);
+
+extern VCHIQ_STATUS_T
+vchiq_open_service_internal(VCHIQ_SERVICE_T *service, int client_id);
+
+extern VCHIQ_STATUS_T
+vchiq_close_service_internal(VCHIQ_SERVICE_T *service, int close_recvd);
+
+extern void
+vchiq_terminate_service_internal(VCHIQ_SERVICE_T *service);
+
+extern void
+vchiq_free_service_internal(VCHIQ_SERVICE_T *service);
+
+extern VCHIQ_STATUS_T
+vchiq_shutdown_internal(VCHIQ_STATE_T *state, VCHIQ_INSTANCE_T instance);
+
+extern VCHIQ_STATUS_T
+vchiq_pause_internal(VCHIQ_STATE_T *state);
+
+extern VCHIQ_STATUS_T
+vchiq_resume_internal(VCHIQ_STATE_T *state);
+
+extern void
+remote_event_pollall(VCHIQ_STATE_T *state);
+
+extern VCHIQ_STATUS_T
+vchiq_bulk_transfer(VCHIQ_SERVICE_T *service,
+ VCHI_MEM_HANDLE_T memhandle, void *offset, int size, void *userdata,
+ VCHIQ_BULK_MODE_T mode, VCHIQ_BULK_DIR_T dir);
+
+extern void
+vchiq_dump_state(void *dump_context, VCHIQ_STATE_T *state);
+
+extern void
+vchiq_dump_service_state(void *dump_context, VCHIQ_SERVICE_T *service);
+
+/* The following functions are called from vchiq_core, and external
+ implementations must be provided. */
+
+extern VCHIQ_STATUS_T
+vchiq_prepare_bulk_data(VCHIQ_BULK_T *bulk,
+ VCHI_MEM_HANDLE_T memhandle, void *offset, int size, int dir);
+
+extern void
+vchiq_transfer_bulk(VCHIQ_BULK_T *bulk);
+
+extern void
+vchiq_complete_bulk(VCHIQ_BULK_T *bulk);
+
+extern VCHIQ_STATUS_T
+vchiq_copy_from_user(void *dst, const void *src, int size);
+
+extern void
+remote_event_signal(REMOTE_EVENT_T *event);
+
+extern void
+vchiq_platform_paused(VCHIQ_STATE_T *state);
+
+extern void
+vchiq_platform_resumed(VCHIQ_STATE_T *state);
+
+extern void
+vchiq_dump(void *dump_context, const char *str, int len);
+
+extern void
+vchiq_dump_platform_state(void *dump_context);
+
+extern void
+vchiq_dump_platform_instances(void *dump_context);
+
+extern void
+vchiq_dump_platform_service_state(void *dump_context,
+ VCHIQ_SERVICE_T *service);
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_if.h
@@ -0,0 +1,148 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_IF_H
+#define VCHIQ_IF_H
+
+#include "interface/vchi/vchi_mh.h"
+
+#define VCHIQ_SLOT_SIZE 4096
+#define VCHIQ_MAX_MSG_SIZE (VCHIQ_SLOT_SIZE - sizeof(VCHIQ_HEADER_T))
+#define VCHIQ_CHANNEL_SIZE VCHIQ_MAX_MSG_SIZE /* For backwards compatibility */
+
+#define VCHIQ_MAKE_FOURCC(x0, x1, x2, x3) (((x0) << 24) | ((x1) << 16) | ((x2) << 8) | (x3))
+#define VCHIQ_GET_SERVICE_USERDATA(service) (service->userdata)
+#define VCHIQ_GET_SERVICE_FOURCC(service) (service->fourcc)
+
+typedef enum {
+ VCHIQ_SERVICE_OPENED, // service, -, -
+ VCHIQ_SERVICE_CLOSED, // service, -, -
+ VCHIQ_MESSAGE_AVAILABLE, // service, header, -
+ VCHIQ_BULK_TRANSMIT_DONE, // service, -, bulk_userdata
+ VCHIQ_BULK_RECEIVE_DONE, // service, -, bulk_userdata
+ VCHIQ_BULK_TRANSMIT_ABORTED, // service, -, bulk_userdata
+ VCHIQ_BULK_RECEIVE_ABORTED // service, -, bulk_userdata
+} VCHIQ_REASON_T;
+
+typedef enum
+{
+ VCHIQ_ERROR = -1,
+ VCHIQ_SUCCESS = 0,
+ VCHIQ_RETRY = 1
+} VCHIQ_STATUS_T;
+
+typedef enum
+{
+ VCHIQ_BULK_MODE_CALLBACK,
+ VCHIQ_BULK_MODE_BLOCKING,
+ VCHIQ_BULK_MODE_NOCALLBACK
+} VCHIQ_BULK_MODE_T;
+
+typedef enum
+{
+ VCHIQ_SERVICE_OPTION_AUTOCLOSE
+} VCHIQ_SERVICE_OPTION_T;
+
+#ifdef __HIGHC__
+/* Allow zero-sized arrays without warnings */
+#pragma warning (push)
+#pragma warning (disable : 4200)
+#endif
+
+typedef struct vchiq_header_struct {
+ /* The message identifier - opaque to applications. */
+ int msgid;
+
+ /* Size of message data. */
+ unsigned int size;
+
+ char data[0]; /* message */
+} VCHIQ_HEADER_T;
+
+#ifdef __HIGHC__
+#pragma warning (pop)
+#endif
+
+typedef struct {
+ const void *data;
+ int size;
+} VCHIQ_ELEMENT_T;
+
+typedef const struct vchiq_service_base_struct *VCHIQ_SERVICE_HANDLE_T;
+
+typedef VCHIQ_STATUS_T (*VCHIQ_CALLBACK_T)(VCHIQ_REASON_T, VCHIQ_HEADER_T *, VCHIQ_SERVICE_HANDLE_T, void *);
+
+typedef struct vchiq_service_base_struct {
+ int fourcc;
+ VCHIQ_CALLBACK_T callback;
+ void *userdata;
+} VCHIQ_SERVICE_BASE_T;
+
+typedef struct vchiq_service_params_struct {
+ int fourcc;
+ VCHIQ_CALLBACK_T callback;
+ void *userdata;
+ short version; /* Increment for non-trivial changes */
+ short version_min; /* Update for incompatible changes */
+} VCHIQ_SERVICE_PARAMS_T;
+
+typedef struct vchiq_config_struct {
+ int max_msg_size;
+ int bulk_threshold; /* The message size aboce which it is better to use
+ a bulk transfer (<= max_msg_size) */
+ int max_outstanding_bulks;
+ int max_services;
+ short version; /* The version of VCHIQ */
+ short version_min; /* The minimum compatible version of VCHIQ */
+} VCHIQ_CONFIG_T;
+
+typedef struct vchiq_instance_struct *VCHIQ_INSTANCE_T;
+
+extern VCHIQ_STATUS_T vchiq_initialise(VCHIQ_INSTANCE_T *pinstance);
+extern VCHIQ_STATUS_T vchiq_shutdown(VCHIQ_INSTANCE_T instance);
+extern VCHIQ_STATUS_T vchiq_connect(VCHIQ_INSTANCE_T instance);
+extern VCHIQ_STATUS_T vchiq_add_service(VCHIQ_INSTANCE_T instance, int fourcc, VCHIQ_CALLBACK_T callback, void *userdata, VCHIQ_SERVICE_HANDLE_T *pservice);
+extern VCHIQ_STATUS_T vchiq_open_service(VCHIQ_INSTANCE_T instance, int fourcc, VCHIQ_CALLBACK_T callback, void *userdata, VCHIQ_SERVICE_HANDLE_T *pservice);
+extern VCHIQ_STATUS_T vchiq_add_service_params(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice);
+extern VCHIQ_STATUS_T vchiq_open_service_params(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice);
+extern VCHIQ_STATUS_T vchiq_close_service(VCHIQ_SERVICE_HANDLE_T service);
+extern VCHIQ_STATUS_T vchiq_remove_service(VCHIQ_SERVICE_HANDLE_T service);
+extern VCHIQ_STATUS_T vchiq_use_service(VCHIQ_SERVICE_HANDLE_T service);
+extern VCHIQ_STATUS_T vchiq_release_service(VCHIQ_SERVICE_HANDLE_T service);
+
+extern VCHIQ_STATUS_T vchiq_queue_message(VCHIQ_SERVICE_HANDLE_T service, const VCHIQ_ELEMENT_T *elements, int count);
+extern void vchiq_release_message(VCHIQ_SERVICE_HANDLE_T service, VCHIQ_HEADER_T *header);
+extern VCHIQ_STATUS_T vchiq_queue_bulk_transmit(VCHIQ_SERVICE_HANDLE_T service, const void *data, int size, void *userdata);
+extern VCHIQ_STATUS_T vchiq_queue_bulk_receive(VCHIQ_SERVICE_HANDLE_T service, void *data, int size, void *userdata);
+extern VCHIQ_STATUS_T vchiq_queue_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T service, VCHI_MEM_HANDLE_T handle, const void *offset, int size, void *userdata);
+extern VCHIQ_STATUS_T vchiq_queue_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T service, VCHI_MEM_HANDLE_T handle, void *offset, int size, void *userdata);
+extern VCHIQ_STATUS_T vchiq_bulk_transmit(VCHIQ_SERVICE_HANDLE_T service, const void *data, int size, void *userdata, VCHIQ_BULK_MODE_T mode);
+extern VCHIQ_STATUS_T vchiq_bulk_receive(VCHIQ_SERVICE_HANDLE_T service, void *data, int size, void *userdata, VCHIQ_BULK_MODE_T mode);
+extern VCHIQ_STATUS_T vchiq_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T service, VCHI_MEM_HANDLE_T handle, const void *offset, int size, void *userdata, VCHIQ_BULK_MODE_T mode);
+extern VCHIQ_STATUS_T vchiq_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T service, VCHI_MEM_HANDLE_T handle, void *offset, int size, void *userdata, VCHIQ_BULK_MODE_T mode);
+extern int vchiq_get_client_id(VCHIQ_SERVICE_HANDLE_T service);
+extern VCHIQ_STATUS_T vchiq_get_config(VCHIQ_INSTANCE_T instance, int config_size, VCHIQ_CONFIG_T *pconfig);
+extern VCHIQ_STATUS_T vchiq_set_service_option(VCHIQ_SERVICE_HANDLE_T service, VCHIQ_SERVICE_OPTION_T option, int value);
+
+extern VCHIQ_STATUS_T vchiq_dump_phys_mem( VCHIQ_SERVICE_HANDLE_T service, void *ptr, size_t num_bytes );
+
+#endif /* VCHIQ_IF_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_ioctl.h
@@ -0,0 +1,105 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_IOCTLS_H
+#define VCHIQ_IOCTLS_H
+
+#include <linux/ioctl.h>
+#include "vchiq_if.h"
+
+#define VCHIQ_IOC_MAGIC 0xc4
+#define VCHIQ_INVALID_HANDLE -1
+
+typedef struct {
+ VCHIQ_SERVICE_PARAMS_T params;
+ int is_open;
+ int is_vchi;
+ int handle; /* OUT */
+} VCHIQ_CREATE_SERVICE_T;
+
+typedef struct {
+ int handle;
+ int count;
+ const VCHIQ_ELEMENT_T *elements;
+} VCHIQ_QUEUE_MESSAGE_T;
+
+typedef struct {
+ int handle;
+ void *data;
+ int size;
+ void *userdata;
+ VCHIQ_BULK_MODE_T mode;
+} VCHIQ_QUEUE_BULK_TRANSFER_T;
+
+typedef struct {
+ VCHIQ_REASON_T reason;
+ VCHIQ_HEADER_T *header;
+ void *service_userdata;
+ void *bulk_userdata;
+} VCHIQ_COMPLETION_DATA_T;
+
+typedef struct {
+ int count;
+ VCHIQ_COMPLETION_DATA_T *buf;
+ int msgbufsize;
+ int msgbufcount; /* IN/OUT */
+ void **msgbufs;
+} VCHIQ_AWAIT_COMPLETION_T;
+
+typedef struct {
+ int handle;
+ int blocking;
+ int bufsize;
+ void *buf;
+} VCHIQ_DEQUEUE_MESSAGE_T;
+
+typedef struct {
+ int config_size;
+ VCHIQ_CONFIG_T *pconfig;
+} VCHIQ_GET_CONFIG_T;
+
+typedef struct {
+ int handle;
+ VCHIQ_SERVICE_OPTION_T option;
+ int value;
+} VCHIQ_SET_SERVICE_OPTION_T;
+
+typedef struct {
+ void *virt_addr;
+ size_t num_bytes;
+} VCHIQ_DUMP_MEM_T;
+
+#define VCHIQ_IOC_CONNECT _IO(VCHIQ_IOC_MAGIC, 0)
+#define VCHIQ_IOC_SHUTDOWN _IO(VCHIQ_IOC_MAGIC, 1)
+#define VCHIQ_IOC_CREATE_SERVICE _IOWR(VCHIQ_IOC_MAGIC, 2, VCHIQ_CREATE_SERVICE_T)
+#define VCHIQ_IOC_REMOVE_SERVICE _IO(VCHIQ_IOC_MAGIC, 3)
+#define VCHIQ_IOC_QUEUE_MESSAGE _IOW(VCHIQ_IOC_MAGIC, 4, VCHIQ_QUEUE_MESSAGE_T)
+#define VCHIQ_IOC_QUEUE_BULK_TRANSMIT _IOW(VCHIQ_IOC_MAGIC, 5, VCHIQ_QUEUE_BULK_TRANSFER_T)
+#define VCHIQ_IOC_QUEUE_BULK_RECEIVE _IOW(VCHIQ_IOC_MAGIC, 6, VCHIQ_QUEUE_BULK_TRANSFER_T)
+#define VCHIQ_IOC_AWAIT_COMPLETION _IOW(VCHIQ_IOC_MAGIC, 7, VCHIQ_AWAIT_COMPLETION_T)
+#define VCHIQ_IOC_DEQUEUE_MESSAGE _IOW(VCHIQ_IOC_MAGIC, 8, VCHIQ_DEQUEUE_MESSAGE_T)
+#define VCHIQ_IOC_GET_CLIENT_ID _IO(VCHIQ_IOC_MAGIC, 9)
+#define VCHIQ_IOC_GET_CONFIG _IOW(VCHIQ_IOC_MAGIC, 10, VCHIQ_GET_CONFIG_T)
+#define VCHIQ_IOC_CLOSE_SERVICE _IO(VCHIQ_IOC_MAGIC, 11)
+#define VCHIQ_IOC_USE_SERVICE _IO(VCHIQ_IOC_MAGIC, 12)
+#define VCHIQ_IOC_RELEASE_SERVICE _IO(VCHIQ_IOC_MAGIC, 13)
+#define VCHIQ_IOC_SET_SERVICE_OPTION _IOW(VCHIQ_IOC_MAGIC, 14, VCHIQ_SET_SERVICE_OPTION_T)
+#define VCHIQ_IOC_DUMP_PHYS_MEM _IOW(VCHIQ_IOC_MAGIC, 15, VCHIQ_DUMP_MEM_T)
+#define VCHIQ_IOC_MAX 15
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_kern_lib.c
@@ -0,0 +1,297 @@
+/*****************************************************************************
+* Copyright 2001 - 2011 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+/* ---- Include Files ---------------------------------------------------- */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+
+#include "vchiq_core.h"
+#include "vchiq_arm.h"
+#include "interface/vcos/vcos_logging.h"
+
+/* ---- Public Variables ------------------------------------------------- */
+
+extern VCOS_LOG_CAT_T vchiq_core_log_category;
+#define VCOS_LOG_CATEGORY (&vchiq_core_log_category)
+
+/* ---- Private Constants and Types -------------------------------------- */
+
+struct vchiq_instance_struct {
+ VCHIQ_STATE_T *state;
+
+ int connected;
+};
+
+/****************************************************************************
+*
+* vchiq_initialise
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_initialise( VCHIQ_INSTANCE_T *instanceOut )
+{
+ VCHIQ_STATUS_T status = VCHIQ_ERROR;
+ VCHIQ_STATE_T *state;
+ VCHIQ_INSTANCE_T instance = NULL;
+
+ vcos_log_trace( "%s called", __func__ );
+
+ state = vchiq_get_state();
+ if (!state)
+ {
+ printk( KERN_ERR "%s: videocore not initialized\n", __func__ );
+ goto failed;
+ }
+
+ instance = kzalloc( sizeof(*instance), GFP_KERNEL );
+ if( !instance )
+ {
+ printk( KERN_ERR "%s: error allocating vchiq instance\n", __func__ );
+ goto failed;
+ }
+
+ instance->connected = 0;
+ instance->state = state;
+
+ *instanceOut = instance;
+
+ status = VCHIQ_SUCCESS;
+
+failed:
+ vcos_log_trace( "%s(%p): returning %d", __func__, instance, status );
+
+ return status;
+}
+
+/****************************************************************************
+*
+* vchiq_shutdown
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_shutdown( VCHIQ_INSTANCE_T instance )
+{
+ VCHIQ_STATUS_T status;
+ VCHIQ_STATE_T *state = instance->state;
+
+ vcos_log_trace( "%s(%p) called", __func__, instance );
+
+ vcos_mutex_lock(&state->mutex);
+
+ /* Remove all services */
+ status = vchiq_shutdown_internal(state, instance);
+
+ vcos_mutex_unlock(&state->mutex);
+
+ if (status == VCHIQ_SUCCESS)
+ kfree(instance);
+
+ vcos_log_trace( "%s(%p): returning %d", __func__, instance, status );
+
+ return status;
+}
+
+/****************************************************************************
+*
+* vchiq_is_connected
+*
+***************************************************************************/
+
+int vchiq_is_connected(VCHIQ_INSTANCE_T instance)
+{
+ return instance->connected;
+}
+
+/****************************************************************************
+*
+* vchiq_connect
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_connect(VCHIQ_INSTANCE_T instance)
+{
+ VCHIQ_STATUS_T status;
+ VCHIQ_STATE_T *state = instance->state;
+
+ vcos_log_trace( "%s(%p) called", __func__, instance );
+
+ if (vcos_mutex_lock(&state->mutex) != VCOS_SUCCESS) {
+ vcos_log_trace( "%s: call to vcos_mutex_lock failed", __func__ );
+ status = VCHIQ_RETRY;
+ goto failed;
+ }
+ status = vchiq_connect_internal(state, instance);
+
+ if (status == VCHIQ_SUCCESS)
+ instance->connected = 1;
+
+ vcos_mutex_unlock(&state->mutex);
+
+failed:
+ vcos_log_trace( "%s(%p): returning %d", __func__, instance, status );
+
+ return status;
+}
+
+/****************************************************************************
+*
+* vchiq_add_service
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_add_service(
+ VCHIQ_INSTANCE_T instance,
+ int fourcc,
+ VCHIQ_CALLBACK_T callback,
+ void *userdata,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+
+ params.fourcc = fourcc;
+ params.callback = callback;
+ params.userdata = userdata;
+ params.version = 0;
+ params.version_min = 0;
+
+ return vchiq_add_service_params(instance, &params, pservice);
+}
+
+/****************************************************************************
+*
+* vchiq_open_service
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_open_service(
+ VCHIQ_INSTANCE_T instance,
+ int fourcc,
+ VCHIQ_CALLBACK_T callback,
+ void *userdata,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+
+ params.fourcc = fourcc;
+ params.callback = callback;
+ params.userdata = userdata;
+ params.version = 0;
+ params.version_min = 0;
+
+ return vchiq_open_service_params(instance, &params, pservice);
+}
+
+/****************************************************************************
+*
+* vchiq_add_service_params
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_add_service_params(
+ VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_STATUS_T status;
+ VCHIQ_STATE_T *state = instance->state;
+ VCHIQ_SERVICE_T *service;
+ int srvstate;
+
+ vcos_log_trace( "%s(%p) called", __func__, instance );
+
+ *pservice = NULL;
+
+ srvstate = vchiq_is_connected( instance )
+ ? VCHIQ_SRVSTATE_LISTENING
+ : VCHIQ_SRVSTATE_HIDDEN;
+
+ vcos_mutex_lock(&state->mutex);
+
+ service = vchiq_add_service_internal(
+ state,
+ params,
+ srvstate,
+ instance);
+
+ vcos_mutex_unlock(&state->mutex);
+
+ if ( service )
+ {
+ *pservice = &service->base;
+ status = VCHIQ_SUCCESS;
+ }
+ else
+ {
+ status = VCHIQ_ERROR;
+ }
+
+ vcos_log_trace( "%s(%p): returning %d", __func__, instance, status );
+
+ return status;
+}
+
+/****************************************************************************
+*
+* vchiq_open_service_params
+*
+***************************************************************************/
+
+VCHIQ_STATUS_T vchiq_open_service_params(
+ VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_STATUS_T status = VCHIQ_ERROR;
+ VCHIQ_STATE_T *state = instance->state;
+ VCHIQ_SERVICE_T *service;
+
+ vcos_log_trace( "%s(%p) called", __func__, instance );
+
+ *pservice = NULL;
+
+ if (!vchiq_is_connected(instance))
+ goto failed;
+
+ vcos_mutex_lock(&state->mutex);
+
+ service = vchiq_add_service_internal(state,
+ params,
+ VCHIQ_SRVSTATE_OPENING,
+ instance);
+
+ vcos_mutex_unlock(&state->mutex);
+
+ if ( service )
+ {
+ status = vchiq_open_service_internal(service, current->pid);
+ if ( status == VCHIQ_SUCCESS )
+ *pservice = &service->base;
+ else
+ vchiq_remove_service(&service->base);
+ }
+
+failed:
+ vcos_log_trace( "%s(%p): returning %d", __func__, instance, status );
+
+ return status;
+}
+
+EXPORT_SYMBOL(vchiq_initialise);
+EXPORT_SYMBOL(vchiq_shutdown);
+EXPORT_SYMBOL(vchiq_connect);
+EXPORT_SYMBOL(vchiq_add_service);
+EXPORT_SYMBOL(vchiq_open_service);
+EXPORT_SYMBOL(vchiq_add_service_params);
+EXPORT_SYMBOL(vchiq_open_service_params);
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_lib.c
@@ -0,0 +1,1518 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include <unistd.h>
+#include <fcntl.h>
+#include <sys/ioctl.h>
+#include <stdio.h>
+
+#include "vchiq.h"
+#include "vchiq_cfg.h"
+#include "vchiq_ioctl.h"
+#include "interface/vchi/vchi.h"
+#include "interface/vchi/common/endian.h"
+#include "interface/vcos/vcos.h"
+
+#define VCHIQ_MAX_INSTANCE_SERVICES 32
+#define MSGBUF_SIZE (VCHIQ_MAX_MSG_SIZE + sizeof(VCHIQ_HEADER_T))
+
+#define RETRY(r,x) do { r = x; } while ((r == -1) && (errno == EINTR))
+
+#define VCOS_LOG_CATEGORY (&vchiq_lib_log_category)
+
+typedef struct vchiq_service_struct
+{
+ VCHIQ_SERVICE_BASE_T base;
+ int handle;
+ int fd;
+ VCHI_CALLBACK_T vchi_callback;
+ void *peek_buf;
+ int peek_size;
+ int client_id;
+} VCHIQ_SERVICE_T;
+
+typedef struct vchiq_service_struct VCHI_SERVICE_T;
+
+struct vchiq_instance_struct
+{
+ int fd;
+ int initialised;
+ int connected;
+ VCOS_THREAD_T completion_thread;
+ VCOS_MUTEX_T mutex;
+ int used_services;
+ VCHIQ_SERVICE_T services[VCHIQ_MAX_INSTANCE_SERVICES];
+} vchiq_instance;
+
+typedef struct vchiq_instance_struct VCHI_STATE_T;
+
+/* Local data */
+static VCOS_LOG_LEVEL_T vchiq_default_lib_log_level = VCOS_LOG_WARN;
+static VCOS_LOG_CAT_T vchiq_lib_log_category;
+static VCOS_MUTEX_T vchiq_lib_mutex;
+static void *free_msgbufs;
+
+
+/* Local utility functions */
+static VCHIQ_INSTANCE_T
+vchiq_lib_init(void);
+
+static void *completion_thread(void *);
+
+static VCHIQ_STATUS_T
+create_service(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHI_CALLBACK_T vchi_callback,
+ int is_open,
+ VCHIQ_SERVICE_HANDLE_T *pservice);
+
+static int
+fill_peek_buf(VCHI_SERVICE_T *service,
+ VCHI_FLAGS_T flags);
+
+static void *
+alloc_msgbuf(void);
+
+static void
+free_msgbuf(void *buf);
+
+static __inline int
+is_valid_instance(VCHIQ_INSTANCE_T instance)
+{
+ return (instance == &vchiq_instance) && (instance->initialised > 0);
+}
+
+/*
+ * VCHIQ API
+ */
+
+VCHIQ_STATUS_T
+vchiq_initialise(VCHIQ_INSTANCE_T *pinstance)
+{
+ VCHIQ_INSTANCE_T instance;
+
+ instance = vchiq_lib_init();
+
+ vcos_log_trace( "%s: returning instance handle %p", __func__, instance );
+
+ *pinstance = instance;
+
+ return (instance != NULL) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+VCHIQ_STATUS_T
+vchiq_shutdown(VCHIQ_INSTANCE_T instance)
+{
+ vcos_log_trace( "%s called", __func__ );
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ vcos_mutex_lock(&instance->mutex);
+
+ if (instance->initialised == 1)
+ {
+ int i;
+
+ instance->initialised = -1; /* Enter limbo */
+
+ /* Remove all services */
+
+ for (i = 0; i < instance->used_services; i++)
+ {
+ if (instance->services[i].handle != VCHIQ_INVALID_HANDLE)
+ {
+ vchiq_remove_service(&instance->services[i].base);
+ instance->services[i].handle = VCHIQ_INVALID_HANDLE;
+ }
+ }
+
+ if (instance->connected)
+ {
+ int ret;
+ RETRY(ret, ioctl(instance->fd, VCHIQ_IOC_SHUTDOWN, 0));
+ vcos_assert(ret == 0);
+ vcos_thread_join(&instance->completion_thread, NULL);
+ instance->connected = 0;
+ }
+
+ close(instance->fd);
+ instance->fd = -1;
+ }
+ else if (instance->initialised > 1)
+ {
+ instance->initialised--;
+ }
+
+ vcos_mutex_unlock(&instance->mutex);
+
+ vcos_global_lock();
+
+ if (instance->initialised == -1)
+ {
+ vcos_mutex_delete(&instance->mutex);
+ instance->initialised = 0;
+ }
+
+ vcos_global_unlock();
+
+ vcos_log_trace( "%s returning", __func__ );
+
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_connect(VCHIQ_INSTANCE_T instance)
+{
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+
+ vcos_log_trace( "%s called", __func__ );
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ vcos_mutex_lock(&instance->mutex);
+
+ if (!instance->connected)
+ {
+ int ret = ioctl(instance->fd, VCHIQ_IOC_CONNECT, 0);
+ if (ret == 0)
+ {
+ VCOS_THREAD_ATTR_T attrs;
+ instance->connected = 1;
+ vcos_thread_attr_init(&attrs);
+ vcos_thread_create(&instance->completion_thread, "VCHIQ completion",
+ &attrs, completion_thread, instance);
+ }
+ else
+ {
+ status = VCHIQ_ERROR;
+ }
+ }
+
+ vcos_mutex_unlock(&instance->mutex);
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_add_service(VCHIQ_INSTANCE_T instance,
+ int fourcc,
+ VCHIQ_CALLBACK_T callback,
+ void *userdata,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+
+ params.fourcc = fourcc;
+ params.callback = callback;
+ params.userdata = userdata;
+ params.version = 0;
+ params.version_min = 0;
+
+ return vchiq_add_service_params(instance, &params, pservice);
+}
+
+VCHIQ_STATUS_T
+vchiq_open_service(VCHIQ_INSTANCE_T instance,
+ int fourcc,
+ VCHIQ_CALLBACK_T callback,
+ void *userdata,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+
+ params.fourcc = fourcc;
+ params.callback = callback;
+ params.userdata = userdata;
+ params.version = 0;
+ params.version_min = 0;
+
+ return vchiq_open_service_params(instance, &params, pservice);
+}
+
+VCHIQ_STATUS_T
+vchiq_add_service_params(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_STATUS_T status;
+
+ vcos_log_trace( "%s called fourcc = 0x%08x (%c%c%c%c)",
+ __func__,
+ params->fourcc,
+ (params->fourcc >> 24) & 0xff,
+ (params->fourcc >> 16) & 0xff,
+ (params->fourcc >> 8) & 0xff,
+ (params->fourcc ) & 0xff );
+
+ if (!params->callback)
+ return VCHIQ_ERROR;
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ status = create_service(instance,
+ params,
+ NULL/*vchi_callback*/,
+ 0/*!open*/,
+ pservice);
+
+ vcos_log_trace( "%s returning service handle = 0x%08x", __func__, (uint32_t)*pservice );
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_open_service_params(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_STATUS_T status;
+
+ vcos_log_trace( "%s called fourcc = 0x%08x (%c%c%c%c)",
+ __func__,
+ params->fourcc,
+ (params->fourcc >> 24) & 0xff,
+ (params->fourcc >> 16) & 0xff,
+ (params->fourcc >> 8) & 0xff,
+ (params->fourcc ) & 0xff );
+
+ if (!params->callback)
+ return VCHIQ_ERROR;
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ status = create_service(instance,
+ params,
+ NULL/*vchi_callback*/,
+ 1/*open*/,
+ pservice);
+
+ vcos_log_trace( "%s returning service handle = 0x%08x", __func__, (uint32_t)*pservice );
+
+ return status;
+}
+
+VCHIQ_STATUS_T
+vchiq_close_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_CLOSE_SERVICE, service->handle));
+
+ if (ret != 0)
+ return VCHIQ_ERROR;
+
+ service->handle = VCHIQ_INVALID_HANDLE;
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_remove_service(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_REMOVE_SERVICE, service->handle));
+
+ if (ret != 0)
+ return VCHIQ_ERROR;
+
+ service->handle = VCHIQ_INVALID_HANDLE;
+ return VCHIQ_SUCCESS;
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_message(VCHIQ_SERVICE_HANDLE_T handle,
+ const VCHIQ_ELEMENT_T *elements,
+ int count)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_QUEUE_MESSAGE_T args;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ args.handle = service->handle;
+ args.elements = elements;
+ args.count = count;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_MESSAGE, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+void
+vchiq_release_message(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHIQ_HEADER_T *header)
+{
+ vcos_log_trace( "%s handle=%08x, header=%x", __func__, (uint32_t)handle, (uint32_t)header );
+
+ free_msgbuf(header);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_transmit(VCHIQ_SERVICE_HANDLE_T handle,
+ const void *data,
+ int size,
+ void *userdata)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ args.handle = service->handle;
+ args.data = (void *)data;
+ args.size = size;
+ args.userdata = userdata;
+ args.mode = VCHIQ_BULK_MODE_CALLBACK;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_TRANSMIT, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_receive(VCHIQ_SERVICE_HANDLE_T handle,
+ void *data,
+ int size,
+ void *userdata)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ args.handle = service->handle;
+ args.data = data;
+ args.size = size;
+ args.userdata = userdata;
+ args.mode = VCHIQ_BULK_MODE_CALLBACK;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_RECEIVE, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle,
+ const void *offset,
+ int size,
+ void *userdata)
+{
+ vcos_assert(memhandle == VCHI_MEM_HANDLE_INVALID);
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ return vchiq_queue_bulk_transmit(handle, offset, size, userdata);
+}
+
+VCHIQ_STATUS_T
+vchiq_queue_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle,
+ void *offset,
+ int size,
+ void *userdata)
+{
+ vcos_assert(memhandle == VCHI_MEM_HANDLE_INVALID);
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ return vchiq_queue_bulk_receive(handle, offset, size, userdata);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_transmit(VCHIQ_SERVICE_HANDLE_T handle,
+ const void *data,
+ int size,
+ void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ args.handle = service->handle;
+ args.data = (void *)data;
+ args.size = size;
+ args.userdata = userdata;
+ args.mode = mode;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_TRANSMIT, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_receive(VCHIQ_SERVICE_HANDLE_T handle,
+ void *data,
+ int size,
+ void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ vcos_log_trace( "%s called service handle = 0x%08x", __func__, (uint32_t)handle );
+
+ args.handle = service->handle;
+ args.data = data;
+ args.size = size;
+ args.userdata = userdata;
+ args.mode = mode;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_RECEIVE, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_transmit_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle,
+ const void *offset,
+ int size,
+ void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ vcos_assert(memhandle == VCHI_MEM_HANDLE_INVALID);
+
+ return vchiq_bulk_transmit(handle, offset, size, userdata, mode);
+}
+
+VCHIQ_STATUS_T
+vchiq_bulk_receive_handle(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T memhandle,
+ void *offset,
+ int size,
+ void *userdata,
+ VCHIQ_BULK_MODE_T mode)
+{
+ vcos_assert(memhandle == VCHI_MEM_HANDLE_INVALID);
+
+ return vchiq_bulk_receive(handle, offset, size, userdata, mode);
+}
+
+int
+vchiq_get_client_id(VCHIQ_SERVICE_HANDLE_T handle)
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+
+ return ioctl(service->fd, VCHIQ_IOC_GET_CLIENT_ID, service->handle);
+}
+
+VCHIQ_STATUS_T
+vchiq_get_config(VCHIQ_INSTANCE_T instance,
+ int config_size,
+ VCHIQ_CONFIG_T *pconfig)
+{
+ VCHIQ_GET_CONFIG_T args;
+ int ret;
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ args.config_size = config_size;
+ args.pconfig = pconfig;
+
+ RETRY(ret, ioctl(instance->fd, VCHIQ_IOC_GET_CONFIG, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+int32_t
+vchiq_use_service( const VCHIQ_SERVICE_HANDLE_T handle )
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_USE_SERVICE, service->handle));
+ return ret;
+}
+
+int32_t
+vchiq_release_service( const VCHIQ_SERVICE_HANDLE_T handle )
+{
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_RELEASE_SERVICE, service->handle));
+ return ret;
+}
+
+VCHIQ_STATUS_T
+vchiq_set_service_option(VCHIQ_SERVICE_HANDLE_T handle,
+ VCHIQ_SERVICE_OPTION_T option, int value)
+{
+ VCHIQ_SET_SERVICE_OPTION_T args;
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)handle;
+ int ret;
+
+ args.handle = service->handle;
+ args.option = option;
+ args.value = value;
+
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_SET_SERVICE_OPTION, &args));
+
+ return (ret >= 0) ? VCHIQ_SUCCESS : VCHIQ_ERROR;
+}
+
+/*
+ * VCHI API
+ */
+
+/* ----------------------------------------------------------------------
+ * return pointer to the mphi message driver function table
+ * -------------------------------------------------------------------- */
+const VCHI_MESSAGE_DRIVER_T *
+vchi_mphi_message_driver_func_table( void )
+{
+ return NULL;
+}
+
+/* ----------------------------------------------------------------------
+ * return a pointer to the 'single' connection driver fops
+ * -------------------------------------------------------------------- */
+const VCHI_CONNECTION_API_T *
+single_get_func_table( void )
+{
+ return NULL;
+}
+
+VCHI_CONNECTION_T *
+vchi_create_connection( const VCHI_CONNECTION_API_T * function_table,
+ const VCHI_MESSAGE_DRIVER_T * low_level )
+{
+ vcos_unused(function_table);
+ vcos_unused(low_level);
+
+ return NULL;
+}
+
+/***********************************************************
+ * Name: vchi_msg_peek
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle,
+ * void **data,
+ * uint32_t *msg_size,
+ * VCHI_FLAGS_T flags
+ *
+ * Description: Routine to return a pointer to the current message (to allow in place processing)
+ * The message can be removed using vchi_msg_remove when you're finished
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_msg_peek( VCHI_SERVICE_HANDLE_T handle,
+ void **data,
+ uint32_t *msg_size,
+ VCHI_FLAGS_T flags )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+
+ ret = fill_peek_buf(service, flags);
+
+ if (ret == 0)
+ {
+ *data = service->peek_buf;
+ *msg_size = service->peek_size;
+ }
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_msg_remove
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle,
+ *
+ * Description: Routine to remove a message (after it has been read with vchi_msg_peek)
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_msg_remove( VCHI_SERVICE_HANDLE_T handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+
+ /* Why would you call vchi_msg_remove without calling vchi_msg_peek first? */
+ vcos_assert(service->peek_size >= 0);
+
+ /* Invalidate the content but reuse the buffer */
+ service->peek_size = -1;
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_msg_queue
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * const void *data,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *msg_handle,
+ *
+ * Description: Thin wrapper to queue a message onto a connection
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_msg_queue( VCHI_SERVICE_HANDLE_T handle,
+ const void * data,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * msg_handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ VCHIQ_QUEUE_MESSAGE_T args;
+ VCHIQ_ELEMENT_T element = {data, data_size};
+ int ret;
+
+ vcos_unused(msg_handle);
+ vcos_assert(flags == VCHI_FLAGS_BLOCK_UNTIL_QUEUED);
+
+ args.handle = service->handle;
+ args.elements = &element;
+ args.count = 1;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_MESSAGE, &args));
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_receive
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * void *data_dst,
+ * const uint32_t data_size,
+ * VCHI_FLAGS_T flags
+ * void *bulk_handle
+ *
+ * Description: Routine to setup a rcv buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_bulk_queue_receive( VCHI_SERVICE_HANDLE_T handle,
+ void * data_dst,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * bulk_handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ args.mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ args.mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ args.mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ break;
+ }
+
+ args.handle = service->handle;
+ args.data = data_dst;
+ args.size = data_size;
+ args.userdata = bulk_handle;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_RECEIVE, &args));
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_transmit
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * const void *data_src,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *bulk_handle
+ *
+ * Description: Routine to transmit some data
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_bulk_queue_transmit( VCHI_SERVICE_HANDLE_T handle,
+ const void * data_src,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * bulk_handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ VCHIQ_QUEUE_BULK_TRANSFER_T args;
+ int ret;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ args.mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_DATA_READ:
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ args.mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ args.mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ break;
+ }
+
+ args.handle = service->handle;
+ args.data = (void *)data_src;
+ args.size = data_size;
+ args.userdata = bulk_handle;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_BULK_TRANSMIT, &args));
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_msg_dequeue
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * void *data,
+ * uint32_t max_data_size_to_read,
+ * uint32_t *actual_msg_size
+ * VCHI_FLAGS_T flags
+ *
+ * Description: Routine to dequeue a message into the supplied buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_msg_dequeue( VCHI_SERVICE_HANDLE_T handle,
+ void *data,
+ uint32_t max_data_size_to_read,
+ uint32_t *actual_msg_size,
+ VCHI_FLAGS_T flags )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ VCHIQ_DEQUEUE_MESSAGE_T args;
+ int ret;
+
+ vcos_assert(flags == VCHI_FLAGS_NONE || flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+
+ if (service->peek_size >= 0)
+ {
+ fprintf(stderr, "vchi_msg_dequeue -> using peek buffer\n");
+ if ((uint32_t)service->peek_size <= max_data_size_to_read)
+ {
+ memcpy(data, service->peek_buf, service->peek_size);
+ *actual_msg_size = service->peek_size;
+ /* Invalidate the peek data, but retain the buffer */
+ service->peek_size = -1;
+ ret = 0;
+ }
+ else
+ {
+ ret = -1;
+ }
+ }
+ else
+ {
+ args.handle = service->handle;
+ args.blocking = (flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+ args.bufsize = max_data_size_to_read;
+ args.buf = data;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_DEQUEUE_MESSAGE, &args));
+ if (ret >= 0)
+ {
+ *actual_msg_size = ret;
+ ret = 0;
+ }
+ }
+
+ if ((ret < 0) && (errno != EWOULDBLOCK))
+ fprintf(stderr, "vchi_msg_dequeue -> %d(%d)\n", ret, errno);
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_msg_queuev
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * const void *data,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *msg_handle
+ *
+ * Description: Thin wrapper to queue a message onto a connection
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+
+vcos_static_assert(sizeof(VCHI_MSG_VECTOR_T) == sizeof(VCHIQ_ELEMENT_T));
+vcos_static_assert(offsetof(VCHI_MSG_VECTOR_T, vec_base) == offsetof(VCHIQ_ELEMENT_T, data));
+vcos_static_assert(offsetof(VCHI_MSG_VECTOR_T, vec_len) == offsetof(VCHIQ_ELEMENT_T, size));
+
+int32_t
+vchi_msg_queuev( VCHI_SERVICE_HANDLE_T handle,
+ VCHI_MSG_VECTOR_T * vector,
+ uint32_t count,
+ VCHI_FLAGS_T flags,
+ void *msg_handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ VCHIQ_QUEUE_MESSAGE_T args;
+ int ret;
+
+ vcos_unused(msg_handle);
+
+ vcos_assert(flags == VCHI_FLAGS_BLOCK_UNTIL_QUEUED);
+
+ args.handle = service->handle;
+ args.elements = (const VCHIQ_ELEMENT_T *)vector;
+ args.count = count;
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_QUEUE_MESSAGE, &args));
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_held_msg_release
+ *
+ * Arguments: VCHI_HELD_MSG_T *message
+ *
+ * Description: Routine to release a held message (after it has been read with vchi_msg_hold)
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_held_msg_release( VCHI_HELD_MSG_T *message )
+{
+ int ret = -1;
+
+ if (message && message->message && !message->service)
+ {
+ free_msgbuf(message->message);
+ ret = 0;
+ }
+
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_msg_hold
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * void **data,
+ * uint32_t *msg_size,
+ * VCHI_FLAGS_T flags,
+ * VCHI_HELD_MSG_T *message_handle
+ *
+ * Description: Routine to return a pointer to the current message (to allow in place processing)
+ * The message is dequeued - don't forget to release the message using
+ * vchi_held_msg_release when you're finished
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_msg_hold( VCHI_SERVICE_HANDLE_T handle,
+ void **data,
+ uint32_t *msg_size,
+ VCHI_FLAGS_T flags,
+ VCHI_HELD_MSG_T *message_handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+
+ ret = fill_peek_buf(service, flags);
+
+ if (ret == 0)
+ {
+ *data = service->peek_buf;
+ *msg_size = service->peek_size;
+
+ message_handle->message = service->peek_buf;
+ message_handle->service = NULL;
+
+ service->peek_size = -1;
+ service->peek_buf = NULL;
+ }
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_initialise
+ *
+ * Arguments: VCHI_INSTANCE_T *instance_handle
+ * VCHI_CONNECTION_T **connections
+ * const uint32_t num_connections
+ *
+ * Description: Initialises the hardware but does not transmit anything
+ * When run as a Host App this will be called twice hence the need
+ * to malloc the state information
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+int32_t
+vchi_initialise( VCHI_INSTANCE_T *instance_handle )
+{
+ VCHIQ_INSTANCE_T instance;
+
+ instance = vchiq_lib_init();
+
+ vcos_log_trace( "%s: returning instance handle %p", __func__, instance );
+
+ *instance_handle = (VCHI_INSTANCE_T)instance;
+
+ return (instance != NULL) ? 0 : -1;
+}
+
+/***********************************************************
+ * Name: vchi_connect
+ *
+ * Arguments: VCHI_CONNECTION_T **connections
+ * const uint32_t num_connections
+ * VCHI_INSTANCE_T instance_handle )
+ *
+ * Description: Starts the command service on each connection,
+ * causing INIT messages to be pinged back and forth
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+int32_t
+vchi_connect( VCHI_CONNECTION_T **connections,
+ const uint32_t num_connections,
+ VCHI_INSTANCE_T instance_handle )
+{
+ VCHIQ_STATUS_T status;
+
+ vcos_unused(connections);
+ vcos_unused(num_connections);
+
+ status = vchiq_connect((VCHIQ_INSTANCE_T)instance_handle);
+
+ return (status == VCHIQ_SUCCESS) ? 0 : -1;
+}
+
+
+/***********************************************************
+ * Name: vchi_disconnect
+ *
+ * Arguments: VCHI_INSTANCE_T instance_handle
+ *
+ * Description: Stops the command service on each connection,
+ * causing DE-INIT messages to be pinged back and forth
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+int32_t
+vchi_disconnect( VCHI_INSTANCE_T instance_handle )
+{
+ VCHIQ_STATUS_T status;
+
+ status = vchiq_shutdown((VCHIQ_INSTANCE_T)instance_handle);
+
+ return (status == VCHIQ_SUCCESS) ? 0 : -1;
+}
+
+
+/***********************************************************
+ * Name: vchi_service_open
+ * Name: vchi_service_create
+ *
+ * Arguments: VCHI_INSTANCE_T *instance_handle
+ * SERVICE_CREATION_T *setup,
+ * VCHI_SERVICE_HANDLE_T *handle
+ *
+ * Description: Routine to open a service
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t
+vchi_service_open( VCHI_INSTANCE_T instance_handle,
+ SERVICE_CREATION_T *setup,
+ VCHI_SERVICE_HANDLE_T *handle )
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+ VCHIQ_STATUS_T status;
+
+ memset(&params, 0, sizeof(params));
+ params.fourcc = setup->service_id;
+ params.userdata = setup->callback_param;
+
+ status = create_service((VCHIQ_INSTANCE_T)instance_handle,
+ &params,
+ setup->callback,
+ 1/*open*/,
+ (VCHIQ_SERVICE_HANDLE_T *)handle);
+
+ return (status == VCHIQ_SUCCESS) ? 0 : -1;
+}
+
+int32_t
+vchi_service_create( VCHI_INSTANCE_T instance_handle,
+ SERVICE_CREATION_T *setup, VCHI_SERVICE_HANDLE_T *handle )
+{
+ VCHIQ_SERVICE_PARAMS_T params;
+ VCHIQ_STATUS_T status;
+
+ memset(&params, 0, sizeof(params));
+ params.fourcc = setup->service_id;
+ params.userdata = setup->callback_param;
+
+ status = create_service((VCHIQ_INSTANCE_T)instance_handle,
+ &params,
+ setup->callback,
+ 0/*!open*/,
+ (VCHIQ_SERVICE_HANDLE_T *)handle);
+
+ return (status == VCHIQ_SUCCESS) ? 0 : -1;
+}
+
+int32_t
+vchi_service_close( const VCHI_SERVICE_HANDLE_T handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_REMOVE_SERVICE, service->handle));
+
+ if (ret == 0)
+ service->handle = VCHIQ_INVALID_HANDLE;
+
+ return ret;
+}
+
+int32_t
+vchi_service_destroy( const VCHI_SERVICE_HANDLE_T handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_REMOVE_SERVICE, service->handle));
+
+ if (ret == 0)
+ service->handle = VCHIQ_INVALID_HANDLE;
+
+ return ret;
+}
+
+/* ----------------------------------------------------------------------
+ * read a uint32_t from buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+uint32_t
+vchi_readbuf_uint32( const void *_ptr )
+{
+ const unsigned char *ptr = _ptr;
+ return ptr[0] | (ptr[1] << 8) | (ptr[2] << 16) | (ptr[3] << 24);
+}
+
+/* ----------------------------------------------------------------------
+ * write a uint32_t to buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+void
+vchi_writebuf_uint32( void *_ptr, uint32_t value )
+{
+ unsigned char *ptr = _ptr;
+ ptr[0] = (unsigned char)((value >> 0) & 0xFF);
+ ptr[1] = (unsigned char)((value >> 8) & 0xFF);
+ ptr[2] = (unsigned char)((value >> 16) & 0xFF);
+ ptr[3] = (unsigned char)((value >> 24) & 0xFF);
+}
+
+/* ----------------------------------------------------------------------
+ * read a uint16_t from buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+uint16_t
+vchi_readbuf_uint16( const void *_ptr )
+{
+ const unsigned char *ptr = _ptr;
+ return ptr[0] | (ptr[1] << 8);
+}
+
+/* ----------------------------------------------------------------------
+ * write a uint16_t into the buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+void
+vchi_writebuf_uint16( void *_ptr, uint16_t value )
+{
+ unsigned char *ptr = _ptr;
+ ptr[0] = (value >> 0) & 0xFF;
+ ptr[1] = (value >> 8) & 0xFF;
+}
+
+/***********************************************************
+ * Name: vchi_service_use
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle
+ *
+ * Description: Routine to increment refcount on a service
+ *
+ * Returns: void
+ *
+ ***********************************************************/
+int32_t
+vchi_service_use( const VCHI_SERVICE_HANDLE_T handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_USE_SERVICE, service->handle));
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_service_release
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle
+ *
+ * Description: Routine to decrement refcount on a service
+ *
+ * Returns: void
+ *
+ ***********************************************************/
+int32_t vchi_service_release( const VCHI_SERVICE_HANDLE_T handle )
+{
+ VCHI_SERVICE_T *service = (VCHI_SERVICE_T *)handle;
+ int ret;
+ RETRY(ret,ioctl(service->fd, VCHIQ_IOC_RELEASE_SERVICE, service->handle));
+ return ret;
+}
+
+/*
+ * Support functions
+ */
+
+static VCHIQ_INSTANCE_T
+vchiq_lib_init(void)
+{
+ static int mutex_initialised = 0;
+ static VCOS_MUTEX_T vchiq_lib_mutex;
+ VCHIQ_INSTANCE_T instance = &vchiq_instance;
+
+ vcos_global_lock();
+ if (!mutex_initialised)
+ {
+ vcos_mutex_create(&vchiq_lib_mutex, "vchiq-init");
+
+ vcos_log_set_level( &vchiq_lib_log_category, vchiq_default_lib_log_level );
+ vcos_log_register( "vchiq_lib", &vchiq_lib_log_category );
+
+ mutex_initialised = 1;
+ }
+ vcos_global_unlock();
+
+ vcos_mutex_lock(&vchiq_lib_mutex);
+
+ if (instance->initialised == 0)
+ {
+ instance->fd = open("/dev/vchiq", O_RDWR);
+ if (instance->fd >= 0)
+ {
+ VCHIQ_GET_CONFIG_T args;
+ VCHIQ_CONFIG_T config;
+ int ret;
+ args.config_size = sizeof(config);
+ args.pconfig = &config;
+ RETRY(ret, ioctl(instance->fd, VCHIQ_IOC_GET_CONFIG, &args));
+ if ((ret == 0) && (config.version >= VCHIQ_VERSION_MIN) && (config.version_min <= VCHIQ_VERSION))
+ {
+ instance->used_services = 0;
+ vcos_mutex_create(&instance->mutex, "VCHIQ instance");
+ instance->initialised = 1;
+ }
+ else
+ {
+ if (ret == 0)
+ {
+ vcos_log_error("Incompatible VCHIQ library - driver version %d (min %d), library version %d (min %d)",
+ config.version, config.version_min, VCHIQ_VERSION, VCHIQ_VERSION_MIN);
+ }
+ else
+ {
+ vcos_log_error("Very incompatible VCHIQ library - cannot retrieve driver version");
+ }
+ close(instance->fd);
+ instance = NULL;
+ }
+ }
+ else
+ {
+ instance = NULL;
+ }
+ }
+ else if (instance->initialised > 0)
+ {
+ instance->initialised++;
+ }
+
+ vcos_mutex_unlock(&vchiq_lib_mutex);
+
+ return instance;
+}
+
+static void *
+completion_thread(void *arg)
+{
+ VCHIQ_INSTANCE_T instance = (VCHIQ_INSTANCE_T)arg;
+ VCHIQ_AWAIT_COMPLETION_T args;
+ VCHIQ_COMPLETION_DATA_T completions[8];
+ void *msgbufs[8];
+
+ static const VCHI_CALLBACK_REASON_T vchiq_reason_to_vchi[] =
+ {
+ VCHI_CALLBACK_SERVICE_OPENED, // VCHIQ_SERVICE_OPENED
+ VCHI_CALLBACK_SERVICE_CLOSED, // VCHIQ_SERVICE_CLOSED
+ VCHI_CALLBACK_MSG_AVAILABLE, // VCHIQ_MESSAGE_AVAILABLE
+ VCHI_CALLBACK_BULK_SENT, // VCHIQ_BULK_TRANSMIT_DONE
+ VCHI_CALLBACK_BULK_RECEIVED, // VCHIQ_BULK_RECEIVE_DONE
+ VCHI_CALLBACK_BULK_TRANSMIT_ABORTED, // VCHIQ_BULK_TRANSMIT_ABORTED
+ VCHI_CALLBACK_BULK_RECEIVE_ABORTED, // VCHIQ_BULK_RECEIVE_ABORTED
+ };
+
+ args.count = vcos_countof(completions);
+ args.buf = completions;
+ args.msgbufsize = MSGBUF_SIZE;
+ args.msgbufcount = 0;
+ args.msgbufs = msgbufs;
+
+ while (1)
+ {
+ int ret, i;
+
+ while ((unsigned int)args.msgbufcount < vcos_countof(msgbufs))
+ {
+ void *msgbuf = alloc_msgbuf();
+ if (msgbuf)
+ {
+ msgbufs[args.msgbufcount++] = msgbuf;
+ }
+ else
+ {
+ fprintf(stderr, "vchiq_lib: failed to allocate a message buffer\n");
+ vcos_demand(args.msgbufcount != 0);
+ }
+ }
+
+ RETRY(ret, ioctl(instance->fd, VCHIQ_IOC_AWAIT_COMPLETION, &args));
+
+ if (ret <= 0)
+ break;
+
+ for (i = 0; i < ret; i++)
+ {
+ VCHIQ_COMPLETION_DATA_T *completion = &completions[i];
+ VCHIQ_SERVICE_T *service = (VCHIQ_SERVICE_T *)completion->service_userdata;
+ if (service->base.callback)
+ {
+ vcos_log_trace( "callback(%x, %x, %x, %x)",
+ completion->reason, (uint32_t)completion->header,
+ (uint32_t)&service->base, (uint32_t)completion->bulk_userdata );
+ service->base.callback(completion->reason, completion->header,
+ &service->base, completion->bulk_userdata);
+ }
+ else if (service->vchi_callback)
+ {
+ VCHI_CALLBACK_REASON_T vchi_reason =
+ vchiq_reason_to_vchi[completion->reason];
+ service->vchi_callback(service->base.userdata, vchi_reason, completion->bulk_userdata);
+ }
+ }
+ }
+ return NULL;
+}
+
+static VCHIQ_STATUS_T
+create_service(VCHIQ_INSTANCE_T instance,
+ const VCHIQ_SERVICE_PARAMS_T *params,
+ VCHI_CALLBACK_T vchi_callback,
+ int is_open,
+ VCHIQ_SERVICE_HANDLE_T *pservice)
+{
+ VCHIQ_SERVICE_T *service = NULL;
+ VCHIQ_STATUS_T status = VCHIQ_SUCCESS;
+ int i;
+
+ if (!is_valid_instance(instance))
+ return VCHIQ_ERROR;
+
+ vcos_mutex_lock(&instance->mutex);
+
+ /* Find a free service */
+ if (is_open)
+ {
+ /* Find a free service */
+ for (i = 0; i < instance->used_services; i++)
+ {
+ if (instance->services[i].handle == VCHIQ_INVALID_HANDLE)
+ {
+ service = &instance->services[i];
+ break;
+ }
+ }
+ }
+ else
+ {
+ for (i = (instance->used_services - 1); i >= 0; i--)
+ {
+ VCHIQ_SERVICE_T *srv = &instance->services[i];
+ if (srv->handle == VCHIQ_INVALID_HANDLE)
+ {
+ service = srv;
+ }
+ else if (
+ (srv->base.fourcc == params->fourcc) &&
+ ((srv->base.callback != params->callback) ||
+ (srv->vchi_callback != vchi_callback)))
+ {
+ /* There is another server using this fourcc which doesn't match */
+ service = NULL;
+ status = VCHIQ_ERROR;
+ break;
+ }
+ }
+ }
+
+ if (!service && (status == VCHIQ_SUCCESS) &&
+ (instance->used_services < VCHIQ_MAX_INSTANCE_SERVICES))
+ service = &instance->services[instance->used_services++];
+
+ if (service)
+ {
+ VCHIQ_CREATE_SERVICE_T args;
+ int ret;
+ service->base.fourcc = params->fourcc;
+ service->base.callback = params->callback;
+ service->vchi_callback = vchi_callback;
+ service->base.userdata = params->userdata;
+ service->fd = instance->fd;
+ service->peek_size = -1;
+ service->peek_buf = NULL;
+
+ args.params = *params;
+ args.params.userdata = service;
+ args.is_open = is_open;
+ args.is_vchi = (params->callback == NULL);
+ args.handle = -1; /* OUT parameter */
+ RETRY(ret, ioctl(instance->fd, VCHIQ_IOC_CREATE_SERVICE, &args));
+ if (ret == 0)
+ service->handle = args.handle;
+ else
+ status = VCHIQ_ERROR;
+ }
+
+ *pservice = (status == VCHIQ_SUCCESS) ? &service->base : NULL;
+
+ vcos_mutex_unlock(&instance->mutex);
+
+ return status;
+}
+
+static int
+fill_peek_buf(VCHI_SERVICE_T *service,
+ VCHI_FLAGS_T flags)
+{
+ VCHIQ_DEQUEUE_MESSAGE_T args;
+ int ret = 0;
+
+ vcos_assert(flags == VCHI_FLAGS_NONE || flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+
+ if (service->peek_size < 0)
+ {
+ if (!service->peek_buf)
+ service->peek_buf = alloc_msgbuf();
+
+ if (service->peek_buf)
+ {
+ args.handle = service->handle;
+ args.blocking = (flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+ args.bufsize = MSGBUF_SIZE;
+ args.buf = service->peek_buf;
+
+ RETRY(ret, ioctl(service->fd, VCHIQ_IOC_DEQUEUE_MESSAGE, &args));
+
+ if (ret >= 0)
+ {
+ service->peek_size = ret;
+ ret = 0;
+ }
+ else
+ {
+ ret = -1;
+ }
+ }
+ else
+ {
+ ret = -1;
+ }
+ }
+
+ return ret;
+}
+
+
+static void *
+alloc_msgbuf(void)
+{
+ void *msgbuf;
+ vcos_mutex_lock(&vchiq_lib_mutex);
+ msgbuf = free_msgbufs;
+ if (msgbuf)
+ free_msgbufs = *(void **)msgbuf;
+ vcos_mutex_unlock(&vchiq_lib_mutex);
+ if (!msgbuf)
+ msgbuf = malloc(MSGBUF_SIZE);
+ return msgbuf;
+}
+
+static void
+free_msgbuf(void *buf)
+{
+ vcos_mutex_lock(&vchiq_lib_mutex);
+ *(void **)buf = free_msgbufs;
+ free_msgbufs = buf;
+ vcos_mutex_unlock(&vchiq_lib_mutex);
+}
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_memdrv.h
@@ -0,0 +1,45 @@
+/*****************************************************************************
+* Copyright 2001 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#ifndef VCHIQ_MEMDRV_H
+#define VCHIQ_MEMDRV_H
+
+/* ---- Include Files ----------------------------------------------------- */
+
+#include <linux/kernel.h>
+#include "vchiq_if.h"
+
+/* ---- Constants and Types ---------------------------------------------- */
+
+typedef struct
+{
+ void *armSharedMemVirt;
+ dma_addr_t armSharedMemPhys;
+ size_t armSharedMemSize;
+
+ void *vcSharedMemVirt;
+ dma_addr_t vcSharedMemPhys;
+ size_t vcSharedMemSize;
+
+} VCHIQ_SHARED_MEM_INFO_T;
+
+/* ---- Variable Externs ------------------------------------------------- */
+
+/* ---- Function Prototypes ---------------------------------------------- */
+
+void vchiq_get_shared_mem_info( VCHIQ_SHARED_MEM_INFO_T *info );
+
+VCHIQ_STATUS_T vchiq_memdrv_initialise(void);
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_pagelist.h
@@ -0,0 +1,43 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_PAGELIST_H
+#define VCHIQ_PAGELIST_H
+
+#ifndef PAGE_SIZE
+#define PAGE_SIZE 4096
+#endif
+#define CACHE_LINE_SIZE 32
+#define PAGELIST_WRITE 0
+#define PAGELIST_READ 1
+#define PAGELIST_READ_WITH_FRAGMENTS 2
+
+typedef struct pagelist_struct {
+ unsigned long length;
+ unsigned short type;
+ unsigned short offset;
+ unsigned long addrs[1]; /* N.B. 12 LSBs hold the number of following
+ pages at consecutive addresses. */
+} PAGELIST_T;
+
+typedef struct fragments_struct {
+ char headbuf[CACHE_LINE_SIZE];
+ char tailbuf[CACHE_LINE_SIZE];
+} FRAGMENTS_T;
+
+#endif /* VCHIQ_PAGELIST_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_shim.c
@@ -0,0 +1,970 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include "interface/vchi/vchi.h"
+#include "vchiq.h"
+#include "vchiq_core.h"
+
+#include "vchiq_util.h"
+
+#include <stddef.h>
+
+#if defined(__KERNEL__)
+#include <linux/module.h>
+#endif
+
+#define vchiq_status_to_vchi(status) ((int32_t)status)
+
+typedef struct {
+ VCHIQ_SERVICE_HANDLE_T handle;
+
+ VCHIU_QUEUE_T queue;
+
+ VCHI_CALLBACK_T callback;
+ void *callback_param;
+} SHIM_SERVICE_T;
+
+/* ----------------------------------------------------------------------
+ * return pointer to the mphi message driver function table
+ * -------------------------------------------------------------------- */
+#ifdef WIN32
+const VCHI_MESSAGE_DRIVER_T *
+mphi_get_func_table( void )
+{
+ return NULL;
+}
+#endif
+
+/* ----------------------------------------------------------------------
+ * return pointer to the mphi message driver function table
+ * -------------------------------------------------------------------- */
+const VCHI_MESSAGE_DRIVER_T *
+vchi_mphi_message_driver_func_table( void )
+{
+ return NULL;
+}
+
+/* ----------------------------------------------------------------------
+ * return a pointer to the 'single' connection driver fops
+ * -------------------------------------------------------------------- */
+const VCHI_CONNECTION_API_T *
+single_get_func_table( void )
+{
+ return NULL;
+}
+
+VCHI_CONNECTION_T * vchi_create_connection( const VCHI_CONNECTION_API_T * function_table,
+ const VCHI_MESSAGE_DRIVER_T * low_level)
+{
+ vcos_unused(function_table);
+ vcos_unused(low_level);
+ return NULL;
+}
+
+/***********************************************************
+ * Name: vchi_msg_peek
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle,
+ * void **data,
+ * uint32_t *msg_size,
+ * VCHI_FLAGS_T flags
+ *
+ * Description: Routine to return a pointer to the current message (to allow in place processing)
+ * The message can be removed using vchi_msg_remove when you're finished
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_peek( VCHI_SERVICE_HANDLE_T handle,
+ void **data,
+ uint32_t *msg_size,
+ VCHI_FLAGS_T flags )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_HEADER_T *header;
+
+ vcos_assert(flags == VCHI_FLAGS_NONE || flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+
+ if (flags == VCHI_FLAGS_NONE)
+ if (vchiu_queue_is_empty(&service->queue))
+ return -1;
+
+ header = vchiu_queue_peek(&service->queue);
+
+ *data = header->data;
+ *msg_size = header->size;
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_msg_remove
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle,
+ *
+ * Description: Routine to remove a message (after it has been read with vchi_msg_peek)
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_remove( VCHI_SERVICE_HANDLE_T handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_HEADER_T *header;
+
+ header = vchiu_queue_pop(&service->queue);
+
+ vchiq_release_message(service->handle, header);
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_msg_queue
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * const void *data,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *msg_handle,
+ *
+ * Description: Thin wrapper to queue a message onto a connection
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_queue( VCHI_SERVICE_HANDLE_T handle,
+ const void * data,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * msg_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_ELEMENT_T element = {data, data_size};
+ VCHIQ_STATUS_T status;
+
+ vcos_unused(msg_handle);
+
+ vcos_assert(flags == VCHI_FLAGS_BLOCK_UNTIL_QUEUED);
+
+ status = vchiq_queue_message(service->handle, &element, 1);
+
+ // On some platforms, like linux kernel, vchiq_queue_message() may return
+ // VCHIQ_RETRY, so we need to implment a retry mechanism since this
+ // function is supposed to block until queued
+ while ( status == VCHIQ_RETRY )
+ {
+ vcos_sleep( 1 );
+ status = vchiq_queue_message(service->handle, &element, 1);
+ }
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_receive
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * void *data_dst,
+ * const uint32_t data_size,
+ * VCHI_FLAGS_T flags
+ * void *bulk_handle
+ *
+ * Description: Routine to setup a rcv buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_bulk_queue_receive( VCHI_SERVICE_HANDLE_T handle,
+ void * data_dst,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * bulk_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_BULK_MODE_T mode;
+ VCHIQ_STATUS_T status;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ vcos_assert(service->callback);
+ mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ return vchiq_status_to_vchi(VCHIQ_ERROR);
+ }
+
+ status = vchiq_bulk_receive(service->handle, data_dst, data_size,
+ bulk_handle, mode);
+
+ // On some platforms, like linux kernel, vchiq_bulk_receive() may return
+ // VCHIQ_RETRY, so we need to implment a retry mechanism since this
+ // function is supposed to block until queued
+ while ( status == VCHIQ_RETRY )
+ {
+ vcos_sleep( 1 );
+ status = vchiq_bulk_receive(service->handle, data_dst, data_size,
+ bulk_handle, mode);
+ }
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_receive_reloc
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * VCHI_MEM_HANDLE_T h
+ * uint32_t offset
+ * const uint32_t data_size,
+ * VCHI_FLAGS_T flags
+ * void *bulk_handle
+ *
+ * Description: Routine to setup a relocatable rcv buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_bulk_queue_receive_reloc( const VCHI_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T h,
+ uint32_t offset,
+ uint32_t data_size,
+ const VCHI_FLAGS_T flags,
+ void * const bulk_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_BULK_MODE_T mode;
+ VCHIQ_STATUS_T status;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ vcos_assert(service->callback);
+ mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ return vchiq_status_to_vchi(VCHIQ_ERROR);
+ }
+
+ status = vchiq_bulk_receive_handle(service->handle, h, (void*)offset,
+ data_size, bulk_handle, mode);
+
+ // On some platforms, like linux kernel, vchiq_bulk_receive_handle() may
+ // return VCHIQ_RETRY, so we need to implment a retry mechanism since
+ // this function is supposed to block until queued
+ while ( status == VCHIQ_RETRY )
+ {
+ vcos_sleep( 1 );
+ status = vchiq_bulk_receive_handle(service->handle, h, (void*)offset,
+ data_size, bulk_handle, mode);
+ }
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_transmit
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * const void *data_src,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *bulk_handle
+ *
+ * Description: Routine to transmit some data
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_bulk_queue_transmit( VCHI_SERVICE_HANDLE_T handle,
+ const void * data_src,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * bulk_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_BULK_MODE_T mode;
+ VCHIQ_STATUS_T status;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ vcos_assert(service->callback);
+ mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_DATA_READ:
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ return vchiq_status_to_vchi(VCHIQ_ERROR);
+ }
+
+ status = vchiq_bulk_transmit(service->handle, data_src, data_size,
+ bulk_handle, mode);
+
+ // On some platforms, like linux kernel, vchiq_bulk_transmit() may return
+ // VCHIQ_RETRY, so we need to implment a retry mechanism since this
+ // function is supposed to block until queued
+ while ( status == VCHIQ_RETRY )
+ {
+ vcos_sleep( 1 );
+ status = vchiq_bulk_transmit(service->handle, data_src, data_size,
+ bulk_handle, mode);
+ }
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_bulk_queue_transmit_reloc
+ *
+ * Arguments: VCHI_BULK_HANDLE_T handle,
+ * VCHI_MEM_HANDLE_T h_src,
+ * uint32_t offset,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *bulk_handle
+ *
+ * Description: Routine to transmit some data from a relocatable buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+
+int32_t vchi_bulk_queue_transmit_reloc( VCHI_SERVICE_HANDLE_T handle,
+ VCHI_MEM_HANDLE_T h_src,
+ uint32_t offset,
+ uint32_t data_size,
+ VCHI_FLAGS_T flags,
+ void * const bulk_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_BULK_MODE_T mode;
+ VCHIQ_STATUS_T status;
+
+ switch ((int)flags) {
+ case VCHI_FLAGS_CALLBACK_WHEN_OP_COMPLETE | VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ vcos_assert(service->callback);
+ mode = VCHIQ_BULK_MODE_CALLBACK;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_DATA_READ:
+ case VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE:
+ mode = VCHIQ_BULK_MODE_BLOCKING;
+ break;
+ case VCHI_FLAGS_BLOCK_UNTIL_QUEUED:
+ case VCHI_FLAGS_NONE:
+ mode = VCHIQ_BULK_MODE_NOCALLBACK;
+ break;
+ default:
+ vcos_assert(0);
+ return vchiq_status_to_vchi(VCHIQ_ERROR);
+ }
+
+ status = vchiq_bulk_transmit_handle(service->handle, h_src, (void*)offset,
+ data_size, bulk_handle, mode);
+
+ // On some platforms, like linux kernel, vchiq_bulk_transmit_handle() may
+ // return VCHIQ_RETRY, so we need to implment a retry mechanism since this
+ // function is supposed to block until queued
+ while ( status == VCHIQ_RETRY )
+ {
+ vcos_sleep( 1 );
+ status = vchiq_bulk_transmit_handle(service->handle, h_src, (void*)offset,
+ data_size, bulk_handle, mode);
+ }
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_msg_dequeue
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * void *data,
+ * uint32_t max_data_size_to_read,
+ * uint32_t *actual_msg_size
+ * VCHI_FLAGS_T flags
+ *
+ * Description: Routine to dequeue a message into the supplied buffer
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_dequeue( VCHI_SERVICE_HANDLE_T handle,
+ void *data,
+ uint32_t max_data_size_to_read,
+ uint32_t *actual_msg_size,
+ VCHI_FLAGS_T flags )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_HEADER_T *header;
+
+ vcos_assert(flags == VCHI_FLAGS_NONE || flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+
+ if (flags == VCHI_FLAGS_NONE)
+ if (vchiu_queue_is_empty(&service->queue))
+ return -1;
+
+ header = vchiu_queue_pop(&service->queue);
+
+ memcpy(data, header->data, header->size < max_data_size_to_read ? header->size : max_data_size_to_read);
+
+ *actual_msg_size = header->size;
+
+ vchiq_release_message(service->handle, header);
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_msg_queuev
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * const void *data,
+ * uint32_t data_size,
+ * VCHI_FLAGS_T flags,
+ * void *msg_handle
+ *
+ * Description: Thin wrapper to queue a message onto a connection
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+
+vcos_static_assert(sizeof(VCHI_MSG_VECTOR_T) == sizeof(VCHIQ_ELEMENT_T));
+vcos_static_assert(offsetof(VCHI_MSG_VECTOR_T, vec_base) == offsetof(VCHIQ_ELEMENT_T, data));
+vcos_static_assert(offsetof(VCHI_MSG_VECTOR_T, vec_len) == offsetof(VCHIQ_ELEMENT_T, size));
+
+int32_t vchi_msg_queuev( VCHI_SERVICE_HANDLE_T handle,
+ VCHI_MSG_VECTOR_T * vector,
+ uint32_t count,
+ VCHI_FLAGS_T flags,
+ void *msg_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+
+ vcos_unused(msg_handle);
+
+ vcos_assert(flags == VCHI_FLAGS_BLOCK_UNTIL_QUEUED);
+
+ return vchiq_status_to_vchi(vchiq_queue_message(service->handle, (const VCHIQ_ELEMENT_T *)vector, count));
+}
+
+#ifdef USE_MEMMGR
+
+/***********************************************************
+ * Name: vchi_msg_queuev_ex
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * VCHI_MSG_VECTOR_EX_T *vector
+ * uint32_t count
+ * VCHI_FLAGS_T flags,
+ * void *msg_handle
+ *
+ * Description: Thin wrapper to queue an array of messages onto a connection
+ * Supports resolving MEM_HANDLE's at last possible moment to avoid deadlocks.
+ *
+ * Currently just a shim, so deadlocks are still possible!
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_queuev_ex( const VCHI_SERVICE_HANDLE_T handle,
+ VCHI_MSG_VECTOR_EX_T * const vector,
+ const uint32_t count,
+ const VCHI_FLAGS_T flags,
+ void * const msg_handle )
+{
+ int32_t success = -1;
+ // For now, we don't actually support sending anything other than
+ // a pointer, so handles have to be patched up; this is likely
+ // to cause deadlocks. This code is not designed to be either
+ // pretty, efficient, or deadlock-free.
+
+ #define max_vecs 16
+ VCHI_MSG_VECTOR_T copy[max_vecs];
+ const uint8_t *orig[max_vecs];
+
+ int i;
+ vcos_unused(msg_handle);
+
+ if (count > sizeof(copy)/sizeof(copy[0]))
+ {
+ vcos_assert(0);
+ return -1;
+ }
+
+ for (i=0; i<count; i++)
+ {
+ VCHI_MSG_VECTOR_EX_T *v = vector+i;
+
+ switch (vector[i].type)
+ {
+ case VCHI_VEC_POINTER:
+ copy[i].vec_base = v->u.ptr.vec_base;
+ copy[i].vec_len = v->u.ptr.vec_len;
+ break;
+ case VCHI_VEC_HANDLE:
+ vcos_assert(v->u.handle.offset+v->u.handle.vec_len <= mem_get_size(v->u.handle.handle));
+ copy[i].vec_base = (uint8_t*)mem_lock(v->u.handle.handle) + v->u.handle.offset;
+ orig[i] = copy[i].vec_base;
+ copy[i].vec_len = v->u.handle.vec_len;
+ break;
+ case VCHI_VEC_LIST:
+ vcos_assert(0); // FIXME: implement this
+ break;
+ default:
+ vcos_assert(0);
+ }
+ }
+ success = vchi_msg_queuev( handle,
+ copy,
+ count,
+ flags &~ VCHI_FLAGS_INTERNAL,
+ msg_handle );
+ if (vcos_verify(success == 0))
+ {
+ // now we need to patch up the vectors if any have been only partially consumed, and
+ // unlock memory handles.
+
+ for (i=0; i<count; i++)
+ {
+ VCHI_MSG_VECTOR_EX_T *v = vector+i;
+
+ switch (vector[i].type)
+ {
+ case VCHI_VEC_POINTER:
+ if (flags & VCHI_FLAGS_ALLOW_PARTIAL)
+ {
+ v->u.ptr.vec_base = copy[i].vec_base;
+ v->u.ptr.vec_len = copy[i].vec_len;
+ }
+ break;
+ case VCHI_VEC_HANDLE:
+ mem_unlock(v->u.handle.handle);
+ if (flags & VCHI_FLAGS_ALLOW_PARTIAL)
+ {
+ const uint8_t *old = orig[i];
+ uint32_t change = (const uint8_t*)copy[i].vec_base-old;
+ v->u.handle.offset += change;
+ v->u.handle.vec_len -= change;
+ }
+ break;
+ default:
+ vcos_assert(0);
+ }
+ }
+ }
+
+ return vchiq_status_to_vchi(success);
+}
+
+#endif
+
+/***********************************************************
+ * Name: vchi_held_msg_release
+ *
+ * Arguments: VCHI_HELD_MSG_T *message
+ *
+ * Description: Routine to release a held message (after it has been read with vchi_msg_hold)
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_held_msg_release( VCHI_HELD_MSG_T *message )
+{
+ vchiq_release_message((VCHIQ_SERVICE_HANDLE_T)message->service, (VCHIQ_HEADER_T *)message->message);
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_msg_hold
+ *
+ * Arguments: VCHI_SERVICE_HANDLE_T handle,
+ * void **data,
+ * uint32_t *msg_size,
+ * VCHI_FLAGS_T flags,
+ * VCHI_HELD_MSG_T *message_handle
+ *
+ * Description: Routine to return a pointer to the current message (to allow in place processing)
+ * The message is dequeued - don't forget to release the message using
+ * vchi_held_msg_release when you're finished
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+int32_t vchi_msg_hold( VCHI_SERVICE_HANDLE_T handle,
+ void **data,
+ uint32_t *msg_size,
+ VCHI_FLAGS_T flags,
+ VCHI_HELD_MSG_T *message_handle )
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ VCHIQ_HEADER_T *header;
+
+ vcos_assert(flags == VCHI_FLAGS_NONE || flags == VCHI_FLAGS_BLOCK_UNTIL_OP_COMPLETE);
+
+ if (flags == VCHI_FLAGS_NONE)
+ if (vchiu_queue_is_empty(&service->queue))
+ return -1;
+
+ header = vchiu_queue_pop(&service->queue);
+
+ *data = header->data;
+ *msg_size = header->size;
+
+ message_handle->service = (struct opaque_vchi_service_t *)service->handle;
+ message_handle->message = header;
+
+ return 0;
+}
+
+/***********************************************************
+ * Name: vchi_initialise
+ *
+ * Arguments: VCHI_INSTANCE_T *instance_handle
+ * VCHI_CONNECTION_T **connections
+ * const uint32_t num_connections
+ *
+ * Description: Initialises the hardware but does not transmit anything
+ * When run as a Host App this will be called twice hence the need
+ * to malloc the state information
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+
+int32_t vchi_initialise( VCHI_INSTANCE_T *instance_handle )
+{
+ VCHIQ_INSTANCE_T instance;
+ VCHIQ_STATUS_T status;
+
+ status = vchiq_initialise(&instance);
+
+ *instance_handle = (VCHI_INSTANCE_T)instance;
+
+ return vchiq_status_to_vchi(status);
+}
+
+/***********************************************************
+ * Name: vchi_connect
+ *
+ * Arguments: VCHI_CONNECTION_T **connections
+ * const uint32_t num_connections
+ * VCHI_INSTANCE_T instance_handle )
+ *
+ * Description: Starts the command service on each connection,
+ * causing INIT messages to be pinged back and forth
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+int32_t vchi_connect( VCHI_CONNECTION_T **connections,
+ const uint32_t num_connections,
+ VCHI_INSTANCE_T instance_handle )
+{
+ VCHIQ_INSTANCE_T instance = (VCHIQ_INSTANCE_T)instance_handle;
+
+ vcos_unused(connections);
+ vcos_unused(num_connections);
+
+ return vchiq_connect(instance);
+}
+
+
+/***********************************************************
+ * Name: vchi_disconnect
+ *
+ * Arguments: VCHI_INSTANCE_T instance_handle
+ *
+ * Description: Stops the command service on each connection,
+ * causing DE-INIT messages to be pinged back and forth
+ *
+ * Returns: 0 if successful, failure otherwise
+ *
+ ***********************************************************/
+int32_t vchi_disconnect( VCHI_INSTANCE_T instance_handle )
+{
+ VCHIQ_INSTANCE_T instance = (VCHIQ_INSTANCE_T)instance_handle;
+ return vchiq_status_to_vchi(vchiq_shutdown(instance));
+}
+
+
+/***********************************************************
+ * Name: vchi_service_open
+ * Name: vchi_service_create
+ *
+ * Arguments: VCHI_INSTANCE_T *instance_handle
+ * SERVICE_CREATION_T *setup,
+ * VCHI_SERVICE_HANDLE_T *handle
+ *
+ * Description: Routine to open a service
+ *
+ * Returns: int32_t - success == 0
+ *
+ ***********************************************************/
+
+static VCHIQ_STATUS_T shim_callback(VCHIQ_REASON_T reason, VCHIQ_HEADER_T *header, VCHIQ_SERVICE_HANDLE_T handle, void *bulk_user)
+{
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)VCHIQ_GET_SERVICE_USERDATA(handle);
+
+ switch (reason) {
+ case VCHIQ_MESSAGE_AVAILABLE:
+ vchiu_queue_push(&service->queue, header);
+
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_MSG_AVAILABLE, NULL);
+ break;
+ case VCHIQ_BULK_TRANSMIT_DONE:
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_BULK_SENT, bulk_user);
+ break;
+ case VCHIQ_BULK_RECEIVE_DONE:
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_BULK_RECEIVED, bulk_user);
+ break;
+ case VCHIQ_SERVICE_CLOSED:
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_SERVICE_CLOSED, NULL);
+ break;
+ case VCHIQ_SERVICE_OPENED:
+ /* No equivalent VCHI reason */
+ break;
+ case VCHIQ_BULK_TRANSMIT_ABORTED:
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_BULK_TRANSMIT_ABORTED, bulk_user);
+ break;
+ case VCHIQ_BULK_RECEIVE_ABORTED:
+ if (service->callback)
+ service->callback(service->callback_param, VCHI_CALLBACK_BULK_RECEIVE_ABORTED, bulk_user);
+ break;
+ default:
+ vcos_assert(0);
+ break;
+ }
+
+ return VCHIQ_SUCCESS;
+}
+
+static SHIM_SERVICE_T *service_alloc(VCHIQ_INSTANCE_T instance,
+ SERVICE_CREATION_T *setup)
+{
+ SHIM_SERVICE_T *service = vcos_calloc(1, sizeof(SHIM_SERVICE_T), "vchiq_shim");
+
+ vcos_unused(instance);
+
+ if (service)
+ {
+ if (vchiu_queue_init(&service->queue, 64))
+ {
+ service->callback = setup->callback;
+ service->callback_param = setup->callback_param;
+ }
+ else
+ {
+ vcos_free(service);
+ service = NULL;
+ }
+ }
+
+ return service;
+}
+
+static void service_free(SHIM_SERVICE_T *service)
+{
+ if (service)
+ {
+ vchiu_queue_delete(&service->queue);
+ vcos_free((void*)service);
+ }
+}
+
+int32_t vchi_service_open( VCHI_INSTANCE_T instance_handle,
+ SERVICE_CREATION_T *setup,
+ VCHI_SERVICE_HANDLE_T *handle)
+{
+ VCHIQ_INSTANCE_T instance = (VCHIQ_INSTANCE_T)instance_handle;
+ SHIM_SERVICE_T *service = service_alloc(instance, setup);
+ if (service)
+ {
+ VCHIQ_STATUS_T status = vchiq_open_service(instance, setup->service_id, shim_callback, service, &service->handle);
+ if (status != VCHIQ_SUCCESS)
+ {
+ service_free(service);
+ service = NULL;
+ }
+ }
+
+ *handle = (VCHI_SERVICE_HANDLE_T)service;
+
+ return (service != NULL) ? 0 : -1;
+}
+
+int32_t vchi_service_create( VCHI_INSTANCE_T instance_handle,
+ SERVICE_CREATION_T *setup,
+ VCHI_SERVICE_HANDLE_T *handle )
+{
+ VCHIQ_INSTANCE_T instance = (VCHIQ_INSTANCE_T)instance_handle;
+ SHIM_SERVICE_T *service = service_alloc(instance, setup);
+ if (service)
+ {
+ VCHIQ_STATUS_T status = vchiq_add_service(instance, setup->service_id, shim_callback, service, &service->handle);
+ if (status != VCHIQ_SUCCESS)
+ {
+ service_free(service);
+ service = NULL;
+ }
+ }
+
+ *handle = (VCHI_SERVICE_HANDLE_T)service;
+
+ return (service != NULL) ? 0 : -1;
+}
+
+int32_t vchi_service_close( const VCHI_SERVICE_HANDLE_T handle )
+{
+ vcos_unused(handle);
+
+ // YTI??
+ return 0;
+}
+
+/* ----------------------------------------------------------------------
+ * read a uint32_t from buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+uint32_t
+vchi_readbuf_uint32( const void *_ptr )
+{
+ const unsigned char *ptr = _ptr;
+ return ptr[0] | (ptr[1] << 8) | (ptr[2] << 16) | (ptr[3] << 24);
+}
+
+/* ----------------------------------------------------------------------
+ * write a uint32_t to buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+void
+vchi_writebuf_uint32( void *_ptr, uint32_t value )
+{
+ unsigned char *ptr = _ptr;
+ ptr[0] = (unsigned char)((value >> 0) & 0xFF);
+ ptr[1] = (unsigned char)((value >> 8) & 0xFF);
+ ptr[2] = (unsigned char)((value >> 16) & 0xFF);
+ ptr[3] = (unsigned char)((value >> 24) & 0xFF);
+}
+
+/* ----------------------------------------------------------------------
+ * read a uint16_t from buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+uint16_t
+vchi_readbuf_uint16( const void *_ptr )
+{
+ const unsigned char *ptr = _ptr;
+ return ptr[0] | (ptr[1] << 8);
+}
+
+/* ----------------------------------------------------------------------
+ * write a uint16_t into the buffer.
+ * network format is defined to be little endian
+ * -------------------------------------------------------------------- */
+void
+vchi_writebuf_uint16( void *_ptr, uint16_t value )
+{
+ unsigned char *ptr = _ptr;
+ ptr[0] = (value >> 0) & 0xFF;
+ ptr[1] = (value >> 8) & 0xFF;
+}
+
+/***********************************************************
+ * Name: vchi_service_use
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle
+ *
+ * Description: Routine to increment refcount on a service
+ *
+ * Returns: void
+ *
+ ***********************************************************/
+int32_t vchi_service_use( const VCHI_SERVICE_HANDLE_T handle )
+{
+ int32_t ret = -1;
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ if(service)
+ {
+ ret = vchiq_status_to_vchi(vchiq_use_service(service->handle));
+ }
+ return ret;
+}
+
+/***********************************************************
+ * Name: vchi_service_release
+ *
+ * Arguments: const VCHI_SERVICE_HANDLE_T handle
+ *
+ * Description: Routine to decrement refcount on a service
+ *
+ * Returns: void
+ *
+ ***********************************************************/
+int32_t vchi_service_release( const VCHI_SERVICE_HANDLE_T handle )
+{
+ int32_t ret = -1;
+ SHIM_SERVICE_T *service = (SHIM_SERVICE_T *)handle;
+ if(service)
+ {
+ ret = vchiq_status_to_vchi(vchiq_release_service(service->handle));
+ }
+ return ret;
+}
+
+#if defined(__KERNEL__)
+EXPORT_SYMBOL(vchi_initialise);
+EXPORT_SYMBOL(vchi_connect);
+EXPORT_SYMBOL(vchi_bulk_queue_transmit);
+EXPORT_SYMBOL(vchi_msg_dequeue);
+EXPORT_SYMBOL(vchi_msg_queue);
+EXPORT_SYMBOL(vchi_msg_queuev);
+EXPORT_SYMBOL(vchi_service_close);
+EXPORT_SYMBOL(vchi_service_open);
+EXPORT_SYMBOL(vchi_service_create);
+EXPORT_SYMBOL(vchi_service_use);
+EXPORT_SYMBOL(vchi_service_release);
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_util.c
@@ -0,0 +1,97 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#include "vchiq_util.h"
+
+#if !defined(__KERNEL__)
+#include <stdlib.h>
+#endif
+
+static __inline int is_pow2(int i)
+{
+ return i && !(i & (i - 1));
+}
+
+int vchiu_queue_init(VCHIU_QUEUE_T *queue, int size)
+{
+ vcos_assert(is_pow2(size));
+
+ queue->size = size;
+ queue->read = 0;
+ queue->write = 0;
+
+ vcos_event_create(&queue->pop, "vchiu");
+ vcos_event_create(&queue->push, "vchiu");
+
+ queue->storage = vcos_malloc(size * sizeof(VCHIQ_HEADER_T *), VCOS_FUNCTION);
+ if (queue->storage == NULL)
+ {
+ vchiu_queue_delete(queue);
+ return 0;
+ }
+ return 1;
+}
+
+void vchiu_queue_delete(VCHIU_QUEUE_T *queue)
+{
+ vcos_event_delete(&queue->pop);
+ vcos_event_delete(&queue->push);
+ if (queue->storage != NULL)
+ vcos_free(queue->storage);
+}
+
+int vchiu_queue_is_empty(VCHIU_QUEUE_T *queue)
+{
+ return queue->read == queue->write;
+}
+
+void vchiu_queue_push(VCHIU_QUEUE_T *queue, VCHIQ_HEADER_T *header)
+{
+ while (queue->write == queue->read + queue->size)
+ vcos_event_wait(&queue->pop);
+
+ queue->storage[queue->write & (queue->size - 1)] = header;
+
+ queue->write++;
+
+ vcos_event_signal(&queue->push);
+}
+
+VCHIQ_HEADER_T *vchiu_queue_peek(VCHIU_QUEUE_T *queue)
+{
+ while (queue->write == queue->read)
+ vcos_event_wait(&queue->push);
+
+ return queue->storage[queue->read & (queue->size - 1)];
+}
+
+VCHIQ_HEADER_T *vchiu_queue_pop(VCHIU_QUEUE_T *queue)
+{
+ VCHIQ_HEADER_T *header;
+
+ while (queue->write == queue->read)
+ vcos_event_wait(&queue->push);
+
+ header = queue->storage[queue->read & (queue->size - 1)];
+
+ queue->read++;
+
+ vcos_event_signal(&queue->pop);
+
+ return header;
+}
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vchiq_arm/vchiq_util.h
@@ -0,0 +1,47 @@
+/*
+ * Copyright (c) 2010-2011 Broadcom Corporation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ */
+
+#ifndef VCHIQ_UTIL_H
+#define VCHIQ_UTIL_H
+
+#include "vchiq_if.h"
+#include "interface/vcos/vcos.h"
+
+typedef struct {
+ int size;
+ int read;
+ int write;
+
+ VCOS_EVENT_T pop;
+ VCOS_EVENT_T push;
+
+ VCHIQ_HEADER_T **storage;
+} VCHIU_QUEUE_T;
+
+extern int vchiu_queue_init(VCHIU_QUEUE_T *queue, int size);
+extern void vchiu_queue_delete(VCHIU_QUEUE_T *queue);
+
+extern int vchiu_queue_is_empty(VCHIU_QUEUE_T *queue);
+
+extern void vchiu_queue_push(VCHIU_QUEUE_T *queue, VCHIQ_HEADER_T *header);
+
+extern VCHIQ_HEADER_T *vchiu_queue_peek(VCHIU_QUEUE_T *queue);
+extern VCHIQ_HEADER_T *vchiu_queue_pop(VCHIU_QUEUE_T *queue);
+
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_cmd.c
@@ -0,0 +1,681 @@
+/*****************************************************************************
+* Copyright 2009 - 2011 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+/*****************************************************************************
+*
+* This file provides a generic command line interface which allows
+* vcos internals to be manipulated and/or displayed.
+*
+*****************************************************************************/
+
+/* ---- Include Files ---------------------------------------------------- */
+
+#include "interface/vcos/vcos.h"
+
+#ifdef HAVE_VCOS_VERSION
+#include "interface/vcos/vcos_build_info.h"
+#endif
+
+ #ifdef _VIDEOCORE
+#include vcfw/logging/logging.h
+#endif
+
+/* ---- Public Variables ------------------------------------------------- */
+
+/* ---- Private Constants and Types -------------------------------------- */
+
+#define VCOS_LOG_CATEGORY (&vcos_cmd_log_category)
+VCOS_LOG_CAT_T vcos_cmd_log_category;
+
+/* ---- Private Variables ------------------------------------------------ */
+
+static struct VCOS_CMD_GLOBALS_T
+{
+ VCOS_MUTEX_T lock;
+ VCOS_ONCE_T initialized;
+
+ unsigned num_cmd_entries;
+ unsigned num_cmd_alloc;
+ VCOS_CMD_T *cmd_entry;
+
+ VCOS_LOG_CAT_T *log_category;
+} cmd_globals;
+
+/* ---- Private Function Prototypes -------------------------------------- */
+
+static VCOS_STATUS_T help_cmd( VCOS_CMD_PARAM_T *param );
+
+/* ---- Functions ------------------------------------------------------- */
+
+/*****************************************************************************
+*
+* Walks through the commands looking for a particular command
+*
+*****************************************************************************/
+
+static VCOS_CMD_T *find_cmd( VCOS_CMD_T *cmd_entry, const char *name )
+{
+ VCOS_CMD_T *scan_entry = cmd_entry;
+
+ while ( scan_entry->name != NULL )
+ {
+ if ( vcos_strcmp( scan_entry->name, name ) == 0 )
+ {
+ return scan_entry;
+ }
+ scan_entry++;
+ }
+
+ return NULL;
+}
+
+/*****************************************************************************
+*
+* Saves away
+* each line individually.
+*
+*****************************************************************************/
+
+void vcos_cmd_always_log_output( VCOS_LOG_CAT_T *log_category )
+{
+ cmd_globals.log_category = log_category;
+}
+
+/*****************************************************************************
+*
+* Walks through a buffer containing newline separated lines, and logs
+* each line individually.
+*
+*****************************************************************************/
+
+static void cmd_log_results( VCOS_CMD_PARAM_T *param )
+{
+ char *start;
+ char *end;
+
+ start = end = param->result_buf;
+
+ while ( *start != '\0' )
+ {
+ while (( *end != '\0' ) && ( *end != '\n' ))
+ end++;
+
+ if ( *end == '\n' )
+ {
+ *end++ = '\0';
+ }
+
+ if ( cmd_globals.log_category != NULL )
+ {
+ if ( vcos_is_log_enabled( cmd_globals.log_category, VCOS_LOG_INFO ))
+ {
+ vcos_log_impl( cmd_globals.log_category, VCOS_LOG_INFO, "%s", start );
+ }
+ }
+ else
+ {
+ vcos_log_info( "%s", start );
+ }
+
+ start = end;
+ }
+
+ /* Since we logged the buffer, reset the pointer back to the beginning. */
+
+ param->result_ptr = param->result_buf;
+ param->result_buf[0] = '\0';
+}
+
+/*****************************************************************************
+*
+* Since we may have limited output space, we create a generic routine
+* which tries to use the result space, but will switch over to using
+* logging if the output is too large.
+*
+*****************************************************************************/
+
+void vcos_cmd_vprintf( VCOS_CMD_PARAM_T *param, const char *fmt, va_list args )
+{
+ int bytes_written;
+ int bytes_remaining;
+
+ bytes_remaining = (int)(param->result_size - ( param->result_ptr - param->result_buf ));
+
+ bytes_written = vcos_vsnprintf( param->result_ptr, bytes_remaining, fmt, args );
+
+ if ( cmd_globals.log_category != NULL )
+ {
+ /* We're going to log each line as we encounter it. If the buffer
+ * doesn't end in a newline, then we'll wait for one first.
+ */
+
+ if ( (( bytes_written + 1 ) >= bytes_remaining )
+ || ( param->result_ptr[ bytes_written - 1 ] == '\n' ))
+ {
+ cmd_log_results( param );
+ }
+ else
+ {
+ param->result_ptr += bytes_written;
+ }
+ }
+ else
+ {
+ if (( bytes_written + 1 ) >= bytes_remaining )
+ {
+ /* Output doesn't fit - switch over to logging */
+
+ param->use_log = 1;
+
+ *param->result_ptr = '\0'; /* Zap the partial line that didn't fit above. */
+
+ cmd_log_results( param ); /* resets result_ptr */
+
+ bytes_written = vcos_vsnprintf( param->result_ptr, bytes_remaining, fmt, args );
+ }
+ param->result_ptr += bytes_written;
+ }
+}
+
+/*****************************************************************************
+*
+* Prints the output.
+*
+*****************************************************************************/
+
+void vcos_cmd_printf( VCOS_CMD_PARAM_T *param, const char *fmt, ... )
+{
+ va_list args;
+
+ va_start( args, fmt );
+ vcos_cmd_vprintf( param, fmt, args );
+ va_end( args );
+}
+
+/*****************************************************************************
+*
+* Prints the arguments which were on the command line prior to ours.
+*
+*****************************************************************************/
+
+static void print_argument_prefix( VCOS_CMD_PARAM_T *param )
+{
+ int arg_idx;
+
+ for ( arg_idx = 0; &param->argv_orig[arg_idx] != param->argv; arg_idx++ )
+ {
+ vcos_cmd_printf( param, "%s ", param->argv_orig[arg_idx] );
+ }
+}
+
+/*****************************************************************************
+*
+* Prints an error message, prefixed by the command chain required to get
+* to where we're at.
+*
+*****************************************************************************/
+
+void vcos_cmd_error( VCOS_CMD_PARAM_T *param, const char *fmt, ... )
+{
+ va_list args;
+
+ print_argument_prefix( param );
+
+ va_start( args, fmt );
+ vcos_cmd_vprintf( param, fmt, args );
+ va_end( args );
+ vcos_cmd_printf( param, "\n" );
+}
+
+/****************************************************************************
+*
+* usage - prints command usage for an array of commands.
+*
+***************************************************************************/
+
+static void usage( VCOS_CMD_PARAM_T *param, VCOS_CMD_T *cmd_entry )
+{
+ int cmd_idx;
+ int nameWidth = 0;
+ int argsWidth = 0;
+ VCOS_CMD_T *scan_entry;
+
+ vcos_cmd_printf( param, "Usage: " );
+ print_argument_prefix( param );
+ vcos_cmd_printf( param, "command [args ...]\n" );
+ vcos_cmd_printf( param, "\n" );
+ vcos_cmd_printf( param, "Where command is one of the following:\n" );
+
+ for ( cmd_idx = 0; cmd_entry[cmd_idx].name != NULL; cmd_idx++ )
+ {
+ int aw;
+ int nw;
+
+ scan_entry = &cmd_entry[cmd_idx];
+
+ nw = vcos_strlen( scan_entry->name );
+ aw = vcos_strlen( scan_entry->args );
+
+ if ( nw > nameWidth )
+ {
+ nameWidth = nw;
+ }
+ if ( aw > argsWidth )
+ {
+ argsWidth = aw;
+ }
+ }
+
+ for ( cmd_idx = 0; cmd_entry[cmd_idx].name != NULL; cmd_idx++ )
+ {
+ scan_entry = &cmd_entry[cmd_idx];
+
+ vcos_cmd_printf( param, " %-*s %-*s - %s\n",
+ nameWidth, scan_entry->name,
+ argsWidth, scan_entry->args,
+ scan_entry->descr );
+ }
+}
+
+/****************************************************************************
+*
+* Prints the usage for the current command.
+*
+***************************************************************************/
+
+void vcos_cmd_usage( VCOS_CMD_PARAM_T *param )
+{
+ VCOS_CMD_T *cmd_entry;
+
+ cmd_entry = param->cmd_entry;
+
+ if ( cmd_entry->sub_cmd_entry != NULL )
+ {
+ /* This command is command with sub-commands */
+
+ usage( param, param->cmd_entry->sub_cmd_entry );
+ }
+ else
+ {
+ vcos_cmd_printf( param, "Usage: " );
+ print_argument_prefix( param );
+ vcos_cmd_printf( param, "%s - %s\n",
+ param->cmd_entry->args,
+ param->cmd_entry->descr );
+ }
+}
+
+/*****************************************************************************
+*
+* Command to print out the help
+*
+* This help command is only called from the main menu.
+*
+*****************************************************************************/
+
+static VCOS_STATUS_T help_cmd( VCOS_CMD_PARAM_T *param )
+{
+ VCOS_CMD_T *found_entry;
+
+#if 0
+ {
+ int arg_idx;
+
+ vcos_log_trace( "%s: argc = %d", __func__, param->argc );
+ for ( arg_idx = 0; arg_idx < param->argc; arg_idx++ )
+ {
+ vcos_log_trace( "%s: argv[%d] = '%s'", __func__, arg_idx, param->argv[arg_idx] );
+ }
+ }
+#endif
+
+ /* If there is an argument after the word help, then we want to print
+ * help for that command.
+ */
+
+ if ( param->argc == 1 )
+ {
+ if ( param->cmd_parent_entry == cmd_globals.cmd_entry )
+ {
+ /* Bare help - print the command usage for the root */
+
+ usage( param, cmd_globals.cmd_entry );
+ return VCOS_SUCCESS;
+ }
+
+ /* For all other cases help requires an argument */
+
+ vcos_cmd_error( param, "%s requires an argument", param->argv[0] );
+ return VCOS_EINVAL;
+ }
+
+ /* We were given an argument. */
+
+ if (( found_entry = find_cmd( param->cmd_parent_entry, param->argv[1] )) != NULL )
+ {
+ /* Make it look like the command that was specified is the one that's
+ * currently running
+ */
+
+ param->cmd_entry = found_entry;
+ param->argv[0] = param->argv[1];
+ param->argv++;
+ param->argc--;
+
+ vcos_cmd_usage( param );
+ return VCOS_SUCCESS;
+ }
+
+ vcos_cmd_error( param, "- unrecognized command: '%s'", param->argv[1] );
+ return VCOS_ENOENT;
+}
+
+/*****************************************************************************
+*
+* Command to print out the version/build information.
+*
+*****************************************************************************/
+
+#ifdef HAVE_VCOS_VERSION
+
+static VCOS_STATUS_T version_cmd( VCOS_CMD_PARAM_T *param )
+{
+ static const char* copyright = "Copyright (c) 2011 Broadcom";
+
+ vcos_cmd_printf( param, "%s %s\n%s\nversion %s\n",
+ vcos_get_build_date(),
+ vcos_get_build_time(),
+ copyright,
+ vcos_get_build_version() );
+
+ return VCOS_SUCCESS;
+}
+
+#endif
+
+/*****************************************************************************
+*
+* Internal commands
+*
+*****************************************************************************/
+
+static VCOS_CMD_T cmd_help = { "help", "[command]", help_cmd, NULL, "Prints command help information" };
+
+#ifdef HAVE_VCOS_VERSION
+static VCOS_CMD_T cmd_version = { "version", "", version_cmd, NULL, "Prints build/version information" };
+#endif
+
+/*****************************************************************************
+*
+* Walks the command table and executes the commands
+*
+*****************************************************************************/
+
+static VCOS_STATUS_T execute_cmd( VCOS_CMD_PARAM_T *param, VCOS_CMD_T *cmd_entry )
+{
+ const char *cmdStr;
+ VCOS_CMD_T *found_entry;
+
+#if 0
+ {
+ int arg_idx;
+
+ vcos_cmd_printf( param, "%s: argc = %d", __func__, param->argc );
+ for ( arg_idx = 0; arg_idx < param->argc; arg_idx++ )
+ {
+ vcos_cmd_printf( param, " argv[%d] = '%s'", arg_idx, param->argv[arg_idx] );
+ }
+ vcos_cmd_printf( param, "\n" );
+ }
+#endif
+
+ if ( param->argc <= 1 )
+ {
+ /* No command specified */
+
+ vcos_cmd_error( param, "%s - no command specified", param->argv[0] );
+ return VCOS_EINVAL;
+ }
+
+ /* argv[0] is the command/program that caused us to get invoked, so we strip
+ * it off.
+ */
+
+ param->argc--;
+ param->argv++;
+ param->cmd_parent_entry = cmd_entry;
+
+ /* Not the help command, scan for the command and execute it. */
+
+ cmdStr = param->argv[0];
+
+ if (( found_entry = find_cmd( cmd_entry, cmdStr )) != NULL )
+ {
+ if ( found_entry->sub_cmd_entry != NULL )
+ {
+ return execute_cmd( param, found_entry->sub_cmd_entry );
+ }
+
+ param->cmd_entry = found_entry;
+ return found_entry->cmd_fn( param );
+ }
+
+ /* Unrecognized command - check to see if it was the help command */
+
+ if ( vcos_strcmp( cmdStr, cmd_help.name ) == 0 )
+ {
+ return help_cmd( param );
+ }
+
+ vcos_cmd_error( param, "- unrecognized command: '%s'", cmdStr );
+ return VCOS_ENOENT;
+}
+
+/*****************************************************************************
+*
+* Initializes the command line parser.
+*
+*****************************************************************************/
+
+static void vcos_cmd_init( void )
+{
+ vcos_mutex_create( &cmd_globals.lock, "vcos_cmd" );
+
+ cmd_globals.num_cmd_entries = 0;
+ cmd_globals.num_cmd_alloc = 0;
+ cmd_globals.cmd_entry = NULL;
+}
+
+/*****************************************************************************
+*
+* Command line processor.
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cmd_execute( int argc, char **argv, size_t result_size, char *result_buf )
+{
+ VCOS_STATUS_T rc = VCOS_EINVAL;
+ VCOS_CMD_PARAM_T param;
+
+ vcos_once( &cmd_globals.initialized, vcos_cmd_init );
+
+ param.argc = argc;
+ param.argv = param.argv_orig = argv;
+
+ param.use_log = 0;
+ param.result_size = result_size;
+ param.result_ptr = result_buf;
+ param.result_buf = result_buf;
+
+ result_buf[0] = '\0';
+
+ vcos_mutex_lock( &cmd_globals.lock );
+
+ rc = execute_cmd( &param, cmd_globals.cmd_entry );
+
+ if ( param.use_log )
+ {
+ cmd_log_results( &param );
+ vcos_snprintf( result_buf, result_size, "results logged" );
+ }
+ else
+ if ( cmd_globals.log_category != NULL )
+ {
+ if ( result_buf[0] != '\0' )
+ {
+ /* There is a partial line still buffered. */
+
+ vcos_cmd_printf( &param, "\n" );
+ }
+ }
+
+ vcos_mutex_unlock( &cmd_globals.lock );
+
+ return rc;
+}
+
+/*****************************************************************************
+*
+* Registers a command entry with the command line processor
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cmd_register( VCOS_CMD_T *cmd_entry )
+{
+ VCOS_STATUS_T rc;
+ VCOS_UNSIGNED new_num_cmd_alloc;
+ VCOS_CMD_T *new_cmd_entry;
+ VCOS_CMD_T *old_cmd_entry;
+ VCOS_CMD_T *scan_entry;
+
+ vcos_once( &cmd_globals.initialized, vcos_cmd_init );
+
+ vcos_assert( cmd_entry != NULL );
+ vcos_assert( cmd_entry->name != NULL );
+
+ vcos_log_trace( "%s: cmd '%s'", __FUNCTION__, cmd_entry->name );
+
+ vcos_assert( cmd_entry->args != NULL );
+ vcos_assert(( cmd_entry->cmd_fn != NULL ) || ( cmd_entry->sub_cmd_entry != NULL ));
+ vcos_assert( cmd_entry->descr != NULL );
+
+ /* We expect vcos_cmd_init to be called before vcos_logging_init, so we
+ * need to defer registering our logging category until someplace
+ * like right here.
+ */
+
+ if ( vcos_cmd_log_category.name == NULL )
+ {
+ /*
+ * If you're using the command interface, you pretty much always want
+ * log messages from this file to show up. So we change the default
+ * from ERROR to be the more reasonable INFO level.
+ */
+
+ vcos_log_set_level(&vcos_cmd_log_category, VCOS_LOG_INFO);
+ vcos_log_register("vcos_cmd", &vcos_cmd_log_category);
+
+ /* We register a help command so that it shows up in the usage. */
+
+ vcos_cmd_register( &cmd_help );
+#ifdef HAVE_VCOS_VERSION
+ vcos_cmd_register( &cmd_version );
+#endif
+ }
+
+ vcos_mutex_lock( &cmd_globals.lock );
+
+ if ( cmd_globals.num_cmd_entries >= cmd_globals.num_cmd_alloc )
+ {
+ if ( cmd_globals.num_cmd_alloc == 0 )
+ {
+ /* We haven't allocated a table yet */
+ }
+
+ /* The number 8 is rather arbitrary. */
+
+ new_num_cmd_alloc = cmd_globals.num_cmd_alloc + 8;
+
+ /* The + 1 is to ensure that we always have a NULL entry at the end. */
+
+ new_cmd_entry = (VCOS_CMD_T *)vcos_calloc( new_num_cmd_alloc + 1, sizeof( *cmd_entry ), "vcos_cmd_entries" );
+ if ( new_cmd_entry == NULL )
+ {
+ rc = VCOS_ENOMEM;
+ goto out;
+ }
+ memcpy( new_cmd_entry, cmd_globals.cmd_entry, cmd_globals.num_cmd_entries * sizeof( *cmd_entry ));
+ cmd_globals.num_cmd_alloc = new_num_cmd_alloc;
+ old_cmd_entry = cmd_globals.cmd_entry;
+ cmd_globals.cmd_entry = new_cmd_entry;
+ vcos_free( old_cmd_entry );
+ }
+
+ if ( cmd_globals.num_cmd_entries == 0 )
+ {
+ /* This is the first command being registered */
+
+ cmd_globals.cmd_entry[0] = *cmd_entry;
+ }
+ else
+ {
+ /* Keep the list in alphabetical order. We start at the end and work backwards
+ * shuffling entries up one until we find an insertion point.
+ */
+
+ for ( scan_entry = &cmd_globals.cmd_entry[cmd_globals.num_cmd_entries - 1];
+ scan_entry >= cmd_globals.cmd_entry; scan_entry-- )
+ {
+ if ( vcos_strcmp( cmd_entry->name, scan_entry->name ) > 0 )
+ {
+ /* We found an insertion point. */
+
+ break;
+ }
+
+ scan_entry[1] = scan_entry[0];
+ }
+ scan_entry[1] = *cmd_entry;
+ }
+ cmd_globals.num_cmd_entries++;
+
+ rc = VCOS_SUCCESS;
+
+out:
+
+ vcos_mutex_unlock( &cmd_globals.lock );
+ return rc;
+}
+
+/*****************************************************************************
+*
+* Registers multiple commands.
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cmd_register_multiple( VCOS_CMD_T *cmd_entry )
+{
+ VCOS_STATUS_T status;
+
+ while ( cmd_entry->name != NULL )
+ {
+ if (( status = vcos_cmd_register( cmd_entry )) != VCOS_SUCCESS )
+ {
+ return status;
+ }
+ cmd_entry++;
+ }
+ return VCOS_SUCCESS;
+}
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_common.h
@@ -0,0 +1,76 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - common postamble code
+=============================================================================*/
+
+/** \file
+ *
+ * Postamble code included by the platform-specific header files
+ */
+
+#define VCOS_THREAD_PRI_DEFAULT VCOS_THREAD_PRI_NORMAL
+
+#if !defined(VCOS_THREAD_PRI_INCREASE)
+#error Which way to thread priorities go?
+#endif
+
+#if VCOS_THREAD_PRI_INCREASE < 0
+/* smaller numbers are higher priority */
+#define VCOS_THREAD_PRI_LESS(x) ((x)<VCOS_THREAD_PRI_MAX?(x)+1:VCOS_THREAD_PRI_MAX)
+#define VCOS_THREAD_PRI_MORE(x) ((x)>VCOS_THREAD_PRI_MIN?(x)-1:VCOS_THREAD_PRI_MIN)
+#else
+/* bigger numbers are lower priority */
+#define VCOS_THREAD_PRI_MORE(x) ((x)<VCOS_THREAD_PRI_MAX?(x)+1:VCOS_THREAD_PRI_MAX)
+#define VCOS_THREAD_PRI_LESS(x) ((x)>VCOS_THREAD_PRI_MIN?(x)-1:VCOS_THREAD_PRI_MIN)
+#endif
+
+/* Convenience for Brits: */
+#define VCOS_APPLICATION_INITIALISE VCOS_APPLICATION_INITIALIZE
+
+/*
+ * Check for constant definitions
+ */
+#ifndef VCOS_TICKS_PER_SECOND
+#error VCOS_TICKS_PER_SECOND not defined
+#endif
+
+#if !defined(VCOS_THREAD_PRI_MIN) || !defined(VCOS_THREAD_PRI_MAX)
+#error Priority range not defined
+#endif
+
+#if !defined(VCOS_THREAD_PRI_HIGHEST) || !defined(VCOS_THREAD_PRI_LOWEST) || !defined(VCOS_THREAD_PRI_NORMAL)
+#error Priority ordering not defined
+#endif
+
+#if !defined(VCOS_CAN_SET_STACK_ADDR)
+#error Can stack addresses be set on this platform? Please set this macro to either 0 or 1.
+#endif
+
+#if (_VCOS_AFFINITY_CPU0|_VCOS_AFFINITY_CPU1) & (~_VCOS_AFFINITY_MASK)
+#error _VCOS_AFFINITY_CPUxxx values are not consistent with _VCOS_AFFINITY_MASK
+#endif
+
+/** Append to the end of a singly-linked queue, O(1). Works with
+ * any structure where list has members 'head' and 'tail' and
+ * item has a 'next' pointer.
+ */
+#define VCOS_QUEUE_APPEND_TAIL(list, item) {\
+ (item)->next = NULL;\
+ if (!(list)->head) {\
+ (list)->head = (list)->tail = (item); \
+ } else {\
+ (list)->tail->next = (item); \
+ (list)->tail = (item); \
+ } \
+}
+
+#ifndef VCOS_HAVE_TIMER
+VCOSPRE_ void VCOSPOST_ vcos_timer_init(void);
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_blockpool.h
@@ -0,0 +1,260 @@
+/*=============================================================================
+Copyright (c) 2011 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - event flags implemented via a semaphore
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_BLOCKPOOL_H
+#define VCOS_GENERIC_BLOCKPOOL_H
+
+/**
+ * \file
+ *
+ * This provides a generic, thread safe implementation of a VCOS block pool
+ * fixed size memory allocator.
+ */
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/** Bits 0 to (VCOS_BLOCKPOOL_SUBPOOL_BITS - 1) are used to store the
+ * subpool id. */
+#define VCOS_BLOCKPOOL_SUBPOOL_BITS 3
+#define VCOS_BLOCKPOOL_MAX_SUBPOOLS (1 << VCOS_BLOCKPOOL_SUBPOOL_BITS)
+
+/* Make zero an invalid handle at the cost of decreasing the maximum
+ * number of blocks (2^28) by 1. Alternatively, a spare bit could be
+ * used to indicated valid blocks but there are likely to be better
+ * uses for spare bits. e.g. allowing more subpools
+ */
+#define INDEX_OFFSET 1
+
+#define VCOS_BLOCKPOOL_HANDLE_GET_INDEX(h) \
+ (((h) >> VCOS_BLOCKPOOL_SUBPOOL_BITS) - INDEX_OFFSET)
+
+#define VCOS_BLOCKPOOL_HANDLE_GET_SUBPOOL(h) \
+ ((h) & ((1 << VCOS_BLOCKPOOL_SUBPOOL_BITS) - 1))
+
+#define VCOS_BLOCKPOOL_HANDLE_CREATE(i,s) \
+ ((((i) + INDEX_OFFSET) << VCOS_BLOCKPOOL_SUBPOOL_BITS) | (s))
+
+#define VCOS_BLOCKPOOL_INVALID_HANDLE 0
+
+typedef struct VCOS_BLOCKPOOL_HEADER_TAG
+{
+ /* Blocks either refer to to the pool if they are allocated
+ * or the free list if they are available.
+ */
+ union {
+ struct VCOS_BLOCKPOOL_HEADER_TAG *next;
+ struct VCOS_BLOCKPOOL_SUBPOOL_TAG* subpool;
+ } owner;
+} VCOS_BLOCKPOOL_HEADER_T;
+
+typedef struct VCOS_BLOCKPOOL_SUBPOOL_TAG
+{
+ /** VCOS_BLOCKPOOL_SUBPOOL_MAGIC */
+ uint32_t magic;
+ VCOS_BLOCKPOOL_HEADER_T* free_list;
+ /* The start of the pool memory */
+ void *mem;
+ /* Address of the first block header */
+ void *start;
+ /** The number of blocks in this sub-pool */
+ VCOS_UNSIGNED num_blocks;
+ /** Current number of available blocks in this sub-pool */
+ VCOS_UNSIGNED available_blocks;
+ /** Pointers to the pool that owns this sub-pool */
+ struct VCOS_BLOCKPOOL_TAG* owner;
+ /** Define properties such as memory ownership */
+ uint32_t flags;
+} VCOS_BLOCKPOOL_SUBPOOL_T;
+
+typedef struct VCOS_BLOCKPOOL_TAG
+{
+ /** VCOS_BLOCKPOOL_MAGIC */
+ uint32_t magic;
+ /** Thread safety for Alloc, Free, Delete, Stats */
+ VCOS_MUTEX_T mutex;
+ /** The size of the block data */
+ size_t block_data_size;
+ /** Block size inc overheads */
+ size_t block_size;
+ /** Name for debugging */
+ const char *name;
+ /* The number of subpools that may be used */
+ VCOS_UNSIGNED num_subpools;
+ /** Number of blocks in each dynamically allocated subpool */
+ VCOS_UNSIGNED num_extension_blocks;
+ /** Array of subpools. Subpool zero is is not deleted until the pool is
+ * destroed. If the index of the pool is < num_subpools and
+ * subpool[index.mem] is null then the subpool entry is valid but
+ * "not currently allocated" */
+ VCOS_BLOCKPOOL_SUBPOOL_T subpools[VCOS_BLOCKPOOL_MAX_SUBPOOLS];
+} VCOS_BLOCKPOOL_T;
+
+#define VCOS_BLOCKPOOL_ROUND_UP(x,s) (((x) + ((s) - 1)) & ~((s) - 1))
+/**
+ * Calculates the size in bytes required for a block pool containing
+ * num_blocks of size block_size plus any overheads.
+ *
+ * The block pool header (VCOS_BLOCKPOOL_T) is allocated separately
+ *
+ * Overheads:
+ * block_size + header must be a multiple of sizeof(void*)
+ * The start of the first block may need to be up to wordsize - 1 bytes
+ * into the given buffer because statically allocated buffers within structures
+ * are not guaranteed to be word aligned.
+ */
+#define VCOS_BLOCKPOOL_SIZE(num_blocks, block_size) \
+ ((VCOS_BLOCKPOOL_ROUND_UP((block_size) + sizeof(VCOS_BLOCKPOOL_HEADER_T), \
+ sizeof(void*)) * (num_blocks)) + sizeof(void*))
+
+/**
+ * Sanity check to verify whether a handle is potentially a blockpool handle
+ * when the pool pointer is not available.
+ *
+ * If the pool pointer is availabe use vcos_blockpool_elem_to_handle instead.
+ *
+ * @param handle the handle to verify
+ * @param max_blocks the expected maximum number of block in the pool
+ * that the handle belongs to.
+ */
+#define VCOS_BLOCKPOOL_IS_VALID_HANDLE_FORMAT(handle, max_blocks) \
+ ((handle) != VCOS_BLOCKPOOL_INVALID_HANDLE \
+ && VCOS_BLOCKPOOL_HANDLE_GET_INDEX((handle)) < (max_blocks))
+
+VCOSPRE_
+ VCOS_STATUS_T VCOSPOST_ vcos_generic_blockpool_init(VCOS_BLOCKPOOL_T *pool,
+ VCOS_UNSIGNED num_blocks, VCOS_UNSIGNED block_size,
+ void *start, VCOS_UNSIGNED pool_size, const char *name);
+
+VCOSPRE_
+ VCOS_STATUS_T VCOSPOST_ vcos_generic_blockpool_create_on_heap(
+ VCOS_BLOCKPOOL_T *pool, VCOS_UNSIGNED num_blocks,
+ VCOS_UNSIGNED block_size, const char *name);
+
+VCOSPRE_
+ VCOS_STATUS_T VCOSPOST_ vcos_generic_blockpool_extend(VCOS_BLOCKPOOL_T *pool,
+ VCOS_UNSIGNED num_extensions, VCOS_UNSIGNED num_blocks);
+
+VCOSPRE_ void VCOSPOST_ *vcos_generic_blockpool_alloc(VCOS_BLOCKPOOL_T *pool);
+
+VCOSPRE_ void VCOSPOST_ *vcos_generic_blockpool_calloc(VCOS_BLOCKPOOL_T *pool);
+
+VCOSPRE_ void VCOSPOST_ vcos_generic_blockpool_free(void *block);
+
+VCOSPRE_
+ VCOS_UNSIGNED VCOSPOST_ vcos_generic_blockpool_available_count(
+ VCOS_BLOCKPOOL_T *pool);
+
+VCOSPRE_
+ VCOS_UNSIGNED VCOSPOST_ vcos_generic_blockpool_used_count(
+ VCOS_BLOCKPOOL_T *pool);
+
+VCOSPRE_ void VCOSPOST_ vcos_generic_blockpool_delete(VCOS_BLOCKPOOL_T *pool);
+
+VCOSPRE_ uint32_t VCOSPOST_ vcos_generic_blockpool_elem_to_handle(void *block);
+
+VCOSPRE_ void VCOSPOST_
+ *vcos_generic_blockpool_elem_from_handle(
+ VCOS_BLOCKPOOL_T *pool, uint32_t handle);
+
+VCOSPRE_ uint32_t VCOSPOST_
+ vcos_generic_blockpool_is_valid_elem(
+ VCOS_BLOCKPOOL_T *pool, const void *block);
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_blockpool_init(VCOS_BLOCKPOOL_T *pool,
+ VCOS_UNSIGNED num_blocks, VCOS_UNSIGNED block_size,
+ void *start, VCOS_UNSIGNED pool_size, const char *name)
+{
+ return vcos_generic_blockpool_init(pool, num_blocks, block_size,
+ start, pool_size, name);
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_blockpool_create_on_heap(VCOS_BLOCKPOOL_T *pool,
+ VCOS_UNSIGNED num_blocks, VCOS_UNSIGNED block_size, const char *name)
+{
+ return vcos_generic_blockpool_create_on_heap(
+ pool, num_blocks, block_size, name);
+}
+
+VCOS_INLINE_IMPL
+ VCOS_STATUS_T VCOSPOST_ vcos_blockpool_extend(VCOS_BLOCKPOOL_T *pool,
+ VCOS_UNSIGNED num_extensions, VCOS_UNSIGNED num_blocks)
+{
+ return vcos_generic_blockpool_extend(pool, num_extensions, num_blocks);
+}
+
+VCOS_INLINE_IMPL
+void *vcos_blockpool_alloc(VCOS_BLOCKPOOL_T *pool)
+{
+ return vcos_generic_blockpool_alloc(pool);
+}
+
+VCOS_INLINE_IMPL
+void *vcos_blockpool_calloc(VCOS_BLOCKPOOL_T *pool)
+{
+ return vcos_generic_blockpool_calloc(pool);
+}
+
+VCOS_INLINE_IMPL
+void vcos_blockpool_free(void *block)
+{
+ vcos_generic_blockpool_free(block);
+}
+
+VCOS_INLINE_IMPL
+VCOS_UNSIGNED vcos_blockpool_available_count(VCOS_BLOCKPOOL_T *pool)
+{
+ return vcos_generic_blockpool_available_count(pool);
+}
+
+VCOS_INLINE_IMPL
+VCOS_UNSIGNED vcos_blockpool_used_count(VCOS_BLOCKPOOL_T *pool)
+{
+ return vcos_generic_blockpool_used_count(pool);
+}
+
+VCOS_INLINE_IMPL
+void vcos_blockpool_delete(VCOS_BLOCKPOOL_T *pool)
+{
+ vcos_generic_blockpool_delete(pool);
+}
+
+VCOS_INLINE_IMPL
+uint32_t vcos_blockpool_elem_to_handle(void *block)
+{
+ return vcos_generic_blockpool_elem_to_handle(block);
+}
+
+VCOS_INLINE_IMPL
+void *vcos_blockpool_elem_from_handle(VCOS_BLOCKPOOL_T *pool, uint32_t handle)
+{
+ return vcos_generic_blockpool_elem_from_handle(pool, handle);
+}
+
+VCOS_INLINE_IMPL
+uint32_t vcos_blockpool_is_valid_elem(VCOS_BLOCKPOOL_T *pool, const void *block)
+{
+ return vcos_generic_blockpool_is_valid_elem(pool, block);
+}
+#endif /* VCOS_INLINE_BODIES */
+
+
+#ifdef __cplusplus
+}
+#endif
+#endif /* VCOS_GENERIC_BLOCKPOOL_H */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_event_flags.c
@@ -0,0 +1,297 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - event flags implemented via mutexes
+=============================================================================*/
+
+#include "interface/vcos/vcos.h"
+#include "interface/vcos/generic/vcos_generic_event_flags.h"
+
+#include <stddef.h>
+
+/** A structure created by a thread that waits on the event flags
+ * for a particular combination of flags to arrive.
+ */
+typedef struct VCOS_EVENT_WAITER_T
+{
+ VCOS_UNSIGNED requested_events; /**< The events wanted */
+ VCOS_UNSIGNED actual_events; /**< Actual events found */
+ VCOS_UNSIGNED op; /**< The event operation to be used */
+ VCOS_STATUS_T return_status; /**< The return status the waiter should pass back */
+ VCOS_EVENT_FLAGS_T *flags; /**< Pointer to the original 'flags' structure */
+ VCOS_THREAD_T *thread; /**< Thread waiting */
+ struct VCOS_EVENT_WAITER_T *next;
+} VCOS_EVENT_WAITER_T;
+
+#ifndef NDEBUG
+static int waiter_list_valid(VCOS_EVENT_FLAGS_T *flags);
+#endif
+static void event_flags_timer_expired(void *cxt);
+
+VCOS_STATUS_T vcos_generic_event_flags_create(VCOS_EVENT_FLAGS_T *flags, const char *name)
+{
+ VCOS_STATUS_T rc;
+ if ((rc=vcos_mutex_create(&flags->lock, name)) != VCOS_SUCCESS)
+ {
+ return rc;
+ }
+
+ flags->events = 0;
+ flags->waiters.head = flags->waiters.tail = 0;
+ return rc;
+}
+
+void vcos_generic_event_flags_set(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED bitmask,
+ VCOS_OPTION op)
+{
+ vcos_assert(flags);
+ vcos_mutex_lock(&flags->lock);
+ if (op == VCOS_OR)
+ {
+ flags->events |= bitmask;
+ }
+ else if (op == VCOS_AND)
+ {
+ flags->events &= bitmask;
+ }
+ else
+ {
+ vcos_assert(0);
+ }
+
+ /* Now wake up any threads that have now become signalled. */
+ if (flags->waiters.head != NULL)
+ {
+ VCOS_UNSIGNED consumed_events = 0;
+ VCOS_EVENT_WAITER_T **pcurrent_waiter = &flags->waiters.head;
+ VCOS_EVENT_WAITER_T *prev_waiter = NULL;
+
+ /* Walk the chain of tasks suspend on this event flag group to determine
+ * if any of their requests can be satisfied.
+ */
+ while ((*pcurrent_waiter) != NULL)
+ {
+ VCOS_EVENT_WAITER_T *curr_waiter = *pcurrent_waiter;
+
+ /* Determine if this request has been satisfied */
+
+ /* First, find the event flags in common. */
+ VCOS_UNSIGNED waiter_satisfied = flags->events & curr_waiter->requested_events;
+
+ /* Second, determine if all the event flags must match */
+ if (curr_waiter->op & VCOS_AND)
+ {
+ /* All requested events must be present */
+ waiter_satisfied = (waiter_satisfied == curr_waiter->requested_events);
+ }
+
+ /* Wake this one up? */
+ if (waiter_satisfied)
+ {
+
+ if (curr_waiter->op & VCOS_CONSUME)
+ {
+ consumed_events |= curr_waiter->requested_events;
+ }
+
+ /* remove this block from the list, taking care at the end */
+ *pcurrent_waiter = curr_waiter->next;
+ if (curr_waiter->next == NULL)
+ flags->waiters.tail = prev_waiter;
+
+ vcos_assert(waiter_list_valid(flags));
+
+ curr_waiter->return_status = VCOS_SUCCESS;
+ curr_waiter->actual_events = flags->events;
+
+ _vcos_thread_sem_post(curr_waiter->thread);
+ }
+ else
+ {
+ /* move to next element in the list */
+ prev_waiter = *pcurrent_waiter;
+ pcurrent_waiter = &(curr_waiter->next);
+ }
+ }
+
+ flags->events &= ~consumed_events;
+
+ }
+
+ vcos_mutex_unlock(&flags->lock);
+}
+
+void vcos_generic_event_flags_delete(VCOS_EVENT_FLAGS_T *flags)
+{
+ vcos_mutex_delete(&flags->lock);
+}
+
+extern VCOS_STATUS_T vcos_generic_event_flags_get(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED bitmask,
+ VCOS_OPTION op,
+ VCOS_UNSIGNED suspend,
+ VCOS_UNSIGNED *retrieved_bits)
+{
+ VCOS_EVENT_WAITER_T waitreq;
+ VCOS_STATUS_T rc = VCOS_EAGAIN;
+ int satisfied = 0;
+
+ vcos_assert(flags);
+
+ /* default retrieved bits to 0 */
+ *retrieved_bits = 0;
+
+ vcos_mutex_lock(&flags->lock);
+ switch (op & VCOS_EVENT_FLAG_OP_MASK)
+ {
+ case VCOS_AND:
+ if ((flags->events & bitmask) == bitmask)
+ {
+ *retrieved_bits = flags->events;
+ rc = VCOS_SUCCESS;
+ satisfied = 1;
+ if (op & VCOS_CONSUME)
+ flags->events &= ~bitmask;
+ }
+ break;
+
+ case VCOS_OR:
+ if (flags->events & bitmask)
+ {
+ *retrieved_bits = flags->events;
+ rc = VCOS_SUCCESS;
+ satisfied = 1;
+ if (op & VCOS_CONSUME)
+ flags->events &= ~bitmask;
+ }
+ break;
+
+ default:
+ vcos_assert(0);
+ rc = VCOS_EINVAL;
+ break;
+ }
+
+ if (!satisfied && suspend)
+ {
+ /* Have to go to sleep.
+ *
+ * Append to tail so we get FIFO ordering.
+ */
+ waitreq.requested_events = bitmask;
+ waitreq.op = op;
+ waitreq.return_status = VCOS_EAGAIN;
+ waitreq.flags = flags;
+ waitreq.actual_events = 0;
+ waitreq.thread = vcos_thread_current();
+ waitreq.next = 0;
+ vcos_assert(waitreq.thread != (VCOS_THREAD_T*)-1);
+ VCOS_QUEUE_APPEND_TAIL(&flags->waiters, &waitreq);
+
+ if (suspend != (VCOS_UNSIGNED)-1)
+ _vcos_task_timer_set(event_flags_timer_expired, &waitreq, suspend);
+
+ vcos_mutex_unlock(&flags->lock);
+ /* go to sleep and wait to be signalled or timeout */
+
+ _vcos_thread_sem_wait();
+
+ *retrieved_bits = waitreq.actual_events;
+ rc = waitreq.return_status;
+
+ /* cancel the timer - do not do this while holding the mutex as it
+ * might be waiting for the timeout function to complete, which will
+ * try to take the mutex.
+ */
+ if (suspend != (VCOS_UNSIGNED)-1)
+ _vcos_task_timer_cancel();
+ }
+ else
+ {
+ vcos_mutex_unlock(&flags->lock);
+ }
+
+ return rc;
+}
+
+
+/** Called when a get call times out. Remove this thread's
+ * entry from the waiting queue, then resume the thread.
+ */
+static void event_flags_timer_expired(void *cxt)
+{
+ VCOS_EVENT_WAITER_T *waitreq = (VCOS_EVENT_WAITER_T *)cxt;
+ VCOS_EVENT_FLAGS_T *flags = waitreq->flags;
+ VCOS_EVENT_WAITER_T **plist;
+ VCOS_EVENT_WAITER_T *prev = NULL;
+ VCOS_THREAD_T *thread = 0;
+
+ vcos_assert(flags);
+
+ vcos_mutex_lock(&flags->lock);
+
+ /* walk the list of waiting threads on this event group, and remove
+ * the one that has expired.
+ *
+ * FIXME: could use doubly-linked list if lots of threads are found
+ * to be waiting on a single event flag instance.
+ */
+ plist = &flags->waiters.head;
+ while (*plist != NULL)
+ {
+ if (*plist == waitreq)
+ {
+ int at_end;
+ /* found it */
+ thread = (*plist)->thread;
+ at_end = ((*plist)->next == NULL);
+
+ /* link past */
+ *plist = (*plist)->next;
+ if (at_end)
+ flags->waiters.tail = prev;
+
+ break;
+ }
+ prev = *plist;
+ plist = &(*plist)->next;
+ }
+ vcos_assert(waiter_list_valid(flags));
+
+ vcos_mutex_unlock(&flags->lock);
+
+ if (thread)
+ {
+ _vcos_thread_sem_post(thread);
+ }
+}
+
+#ifndef NDEBUG
+
+static int waiter_list_valid(VCOS_EVENT_FLAGS_T *flags)
+{
+ int valid;
+ /* Either both head and tail are NULL, or neither are NULL */
+ if (flags->waiters.head == NULL)
+ {
+ valid = (flags->waiters.tail == NULL);
+ }
+ else
+ {
+ valid = (flags->waiters.tail != NULL);
+ }
+
+ /* If head and tail point at the same non-NULL element, then there
+ * is only one element in the list.
+ */
+ if (flags->waiters.head && (flags->waiters.head == flags->waiters.tail))
+ {
+ valid = (flags->waiters.head->next == NULL);
+ }
+ return valid;
+}
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_event_flags.h
@@ -0,0 +1,104 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - event flags implemented via a semaphore
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_EVENT_FLAGS_H
+#define VCOS_GENERIC_EVENT_FLAGS_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/**
+ * \file
+ *
+ * This provides event flags (as per Nucleus Event Groups) based on a
+ * mutex, a semaphore (per waiting thread) and a timer (per waiting
+ * thread).
+ *
+ * The data structure is a 32 bit unsigned int (the current set of
+ * flags) and a linked list of clients waiting to be 'satisfied'.
+ *
+ * The mutex merely locks access to the data structure. If a client
+ * calls vcos_event_flags_get() and the requested bits are not already
+ * present, it then sleeps on its per-thread semaphore after adding
+ * this semaphore to the queue waiting. It also sets up a timer.
+ *
+ * The per-thread semaphore and timer are actually stored in the
+ * thread context (joinable thread). In future it may become necessary
+ * to support non-VCOS threads by using thread local storage to
+ * create these objects and associate them with the thread.
+ */
+
+struct VCOS_EVENT_WAITER_T;
+
+typedef struct VCOS_EVENT_FLAGS_T
+{
+ VCOS_UNSIGNED events; /**< Events currently set */
+ VCOS_MUTEX_T lock; /**< Serialize access */
+ struct
+ {
+ struct VCOS_EVENT_WAITER_T *head; /**< List of threads waiting */
+ struct VCOS_EVENT_WAITER_T *tail; /**< List of threads waiting */
+ } waiters;
+} VCOS_EVENT_FLAGS_T;
+
+#define VCOS_OR 1
+#define VCOS_AND 2
+#define VCOS_CONSUME 4
+#define VCOS_OR_CONSUME (VCOS_OR | VCOS_CONSUME)
+#define VCOS_AND_CONSUME (VCOS_AND | VCOS_CONSUME)
+#define VCOS_EVENT_FLAG_OP_MASK (VCOS_OR|VCOS_AND)
+
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_generic_event_flags_create(VCOS_EVENT_FLAGS_T *flags, const char *name);
+VCOSPRE_ void VCOSPOST_ vcos_generic_event_flags_set(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED events,
+ VCOS_OPTION op);
+VCOSPRE_ void VCOSPOST_ vcos_generic_event_flags_delete(VCOS_EVENT_FLAGS_T *);
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_generic_event_flags_get(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED requested_events,
+ VCOS_OPTION op,
+ VCOS_UNSIGNED suspend,
+ VCOS_UNSIGNED *retrieved_events);
+
+#ifdef VCOS_INLINE_BODIES
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_event_flags_create(VCOS_EVENT_FLAGS_T *flags, const char *name) {
+ return vcos_generic_event_flags_create(flags, name);
+}
+
+VCOS_INLINE_IMPL
+void vcos_event_flags_set(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED events,
+ VCOS_OPTION op) {
+ vcos_generic_event_flags_set(flags, events, op);
+}
+
+VCOS_INLINE_IMPL
+void vcos_event_flags_delete(VCOS_EVENT_FLAGS_T *f) {
+ vcos_generic_event_flags_delete(f);
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_event_flags_get(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED requested_events,
+ VCOS_OPTION op,
+ VCOS_UNSIGNED suspend,
+ VCOS_UNSIGNED *retrieved_events) {
+ return vcos_generic_event_flags_get(flags, requested_events, op, suspend, retrieved_events);
+}
+
+#endif /* VCOS_INLINE_BODIES */
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_named_sem.h
@@ -0,0 +1,81 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - named semaphores
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_NAMED_SEM_H
+#define VCOS_GENERIC_NAMED_SEM_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/**
+ * \file
+ *
+ * Generic support for named semaphores, using regular ones. This is only
+ * suitable for emulating them on an embedded MMUless system, since there is
+ * no support for opening semaphores across process boundaries.
+ *
+ */
+
+#define VCOS_NAMED_SEMAPHORE_NAMELEN 64
+
+/* In theory we could use the name facility provided within Nucleus. However, this
+ * is hard to do as semaphores are constantly being created and destroyed; we
+ * would need to stop everything while allocating the memory for the semaphore
+ * list and then walking it. So keep our own list.
+ */
+typedef struct VCOS_NAMED_SEMAPHORE_T
+{
+ struct VCOS_NAMED_SEMAPHORE_IMPL_T *actual; /**< There are 'n' named semaphores per 1 actual semaphore */
+ VCOS_SEMAPHORE_T *sem; /**< Pointer to actual underlying semaphore */
+} VCOS_NAMED_SEMAPHORE_T;
+
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_
+vcos_generic_named_semaphore_create(VCOS_NAMED_SEMAPHORE_T *sem, const char *name, VCOS_UNSIGNED count);
+
+VCOSPRE_ void VCOSPOST_ vcos_named_semaphore_delete(VCOS_NAMED_SEMAPHORE_T *sem);
+
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ _vcos_named_semaphore_init(void);
+VCOSPRE_ void VCOSPOST_ _vcos_named_semaphore_deinit(void);
+
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_named_semaphore_create(VCOS_NAMED_SEMAPHORE_T *sem, const char *name, VCOS_UNSIGNED count) {
+ return vcos_generic_named_semaphore_create(sem, name, count);
+}
+
+VCOS_INLINE_IMPL
+void vcos_named_semaphore_wait(VCOS_NAMED_SEMAPHORE_T *sem) {
+ vcos_semaphore_wait(sem->sem);
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_named_semaphore_trywait(VCOS_NAMED_SEMAPHORE_T *sem) {
+ return vcos_semaphore_trywait(sem->sem);
+}
+
+VCOS_INLINE_IMPL
+void vcos_named_semaphore_post(VCOS_NAMED_SEMAPHORE_T *sem) {
+ vcos_semaphore_post(sem->sem);
+}
+
+
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_quickslow_mutex.h
@@ -0,0 +1,75 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - reentrant mutexes created from regular ones.
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_QUICKSLOW_MUTEX_H
+#define VCOS_GENERIC_QUICKSLOW_MUTEX_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/**
+ * \file
+ *
+ * Quickslow Mutexes implemented as regular ones (i.e. quick and slow modes are the same).
+ *
+ */
+
+typedef VCOS_MUTEX_T VCOS_QUICKSLOW_MUTEX_T;
+
+#if defined(VCOS_INLINE_BODIES)
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_quickslow_mutex_create(VCOS_QUICKSLOW_MUTEX_T *m, const char *name)
+{
+ return vcos_mutex_create(m, name);
+}
+
+VCOS_INLINE_IMPL
+void vcos_quickslow_mutex_delete(VCOS_QUICKSLOW_MUTEX_T *m)
+{
+ vcos_mutex_delete(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_quickslow_mutex_lock(VCOS_QUICKSLOW_MUTEX_T *m)
+{
+ while (vcos_mutex_lock(m) == VCOS_EAGAIN);
+}
+
+VCOS_INLINE_IMPL
+void vcos_quickslow_mutex_unlock(VCOS_QUICKSLOW_MUTEX_T *m)
+{
+ vcos_mutex_unlock(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_quickslow_mutex_lock_quick(VCOS_QUICKSLOW_MUTEX_T *m)
+{
+ while (vcos_mutex_lock(m) == VCOS_EAGAIN);
+}
+
+VCOS_INLINE_IMPL
+void vcos_quickslow_mutex_unlock_quick(VCOS_QUICKSLOW_MUTEX_T *m)
+{
+ vcos_mutex_unlock(m);
+}
+
+#endif
+
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_reentrant_mtx.h
@@ -0,0 +1,75 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - reentrant mutexes created from regular ones.
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_REENTRANT_MUTEX_H
+#define VCOS_GENERIC_REENTRANT_MUTEX_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/**
+ * \file
+ *
+ * Reentrant Mutexes from regular ones.
+ *
+ */
+
+typedef struct VCOS_REENTRANT_MUTEX_T
+{
+ VCOS_MUTEX_T mutex;
+ VCOS_THREAD_T *owner;
+ unsigned count;
+} VCOS_REENTRANT_MUTEX_T;
+
+/* Extern definitions of functions that do the actual work */
+
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_generic_reentrant_mutex_create(VCOS_REENTRANT_MUTEX_T *m, const char *name);
+
+VCOSPRE_ void VCOSPOST_ vcos_generic_reentrant_mutex_delete(VCOS_REENTRANT_MUTEX_T *m);
+
+VCOSPRE_ void VCOSPOST_ vcos_generic_reentrant_mutex_lock(VCOS_REENTRANT_MUTEX_T *m);
+
+VCOSPRE_ void VCOSPOST_ vcos_generic_reentrant_mutex_unlock(VCOS_REENTRANT_MUTEX_T *m);
+
+/* Inline forwarding functions */
+
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_reentrant_mutex_create(VCOS_REENTRANT_MUTEX_T *m, const char *name) {
+ return vcos_generic_reentrant_mutex_create(m,name);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_delete(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_generic_reentrant_mutex_delete(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_lock(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_generic_reentrant_mutex_lock(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_unlock(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_generic_reentrant_mutex_unlock(m);
+}
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_generic_tls.h
@@ -0,0 +1,144 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - generic thread local storage
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_TLS_H
+#define VCOS_GENERIC_TLS_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+/**
+ * \file
+ *
+ * Do an emulation of Thread Local Storage. The platform needs to
+ * provide a way to set and get a per-thread pointer which is
+ * where the TLS data itself is stored.
+ *
+ *
+ * Each thread that wants to join in this scheme needs to call
+ * vcos_tls_thread_register().
+ *
+ * The platform needs to support the macros/functions
+ * _vcos_tls_thread_ptr_set() and _vcos_tls_thread_ptr_get().
+ */
+
+#ifndef VCOS_WANT_TLS_EMULATION
+#error Should not be included unless TLS emulation is defined
+#endif
+
+/** Number of slots to reserve per thread. This results in an overhead
+ * of this many words per thread.
+ */
+#define VCOS_TLS_MAX_SLOTS 4
+
+/** TLS key. Allocating one of these reserves the client one of the
+ * available slots.
+ */
+typedef VCOS_UNSIGNED VCOS_TLS_KEY_T;
+
+/** TLS per-thread structure. Each thread gets one of these
+ * if TLS emulation (rather than native TLS support) is
+ * being used.
+ */
+typedef struct VCOS_TLS_THREAD_T
+{
+ void *slots[VCOS_TLS_MAX_SLOTS];
+} VCOS_TLS_THREAD_T;
+
+/*
+ * Internal APIs
+ */
+
+/** Register this thread's TLS storage area. */
+VCOSPRE_ void VCOSPOST_ vcos_tls_thread_register(VCOS_TLS_THREAD_T *);
+
+/** Create a new TLS key */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_generic_tls_create(VCOS_TLS_KEY_T *key);
+
+/** Delete a TLS key */
+VCOSPRE_ void VCOSPOST_ vcos_generic_tls_delete(VCOS_TLS_KEY_T tls);
+
+/** Initialise the TLS library */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_tls_init(void);
+
+/** Deinitialise the TLS library */
+VCOSPRE_ void VCOSPOST_ vcos_tls_deinit(void);
+
+#if defined(VCOS_INLINE_BODIES)
+
+#undef VCOS_ASSERT_LOGGING_DISABLE
+#define VCOS_ASSERT_LOGGING_DISABLE 1
+
+/*
+ * Implementations of public API functions
+ */
+
+/** Set the given value. Since everything is per-thread, there is no need
+ * for any locking.
+ */
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_tls_set(VCOS_TLS_KEY_T tls, void *v) {
+ VCOS_TLS_THREAD_T *tlsdata = _vcos_tls_thread_ptr_get();
+ vcos_assert(tlsdata); /* Fires if this thread has not been registered */
+ if (tls<VCOS_TLS_MAX_SLOTS)
+ {
+ tlsdata->slots[tls] = v;
+ return VCOS_SUCCESS;
+ }
+ else
+ {
+ vcos_assert(0);
+ return VCOS_EINVAL;
+ }
+}
+
+/** Get the given value. No locking required.
+ */
+VCOS_INLINE_IMPL
+void *vcos_tls_get(VCOS_TLS_KEY_T tls) {
+ VCOS_TLS_THREAD_T *tlsdata = _vcos_tls_thread_ptr_get();
+ vcos_assert(tlsdata); /* Fires if this thread has not been registered */
+ if (tls<VCOS_TLS_MAX_SLOTS)
+ {
+ return tlsdata->slots[tls];
+ }
+ else
+ {
+ vcos_assert(0);
+ return NULL;
+ }
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_tls_create(VCOS_TLS_KEY_T *key) {
+ return vcos_generic_tls_create(key);
+}
+
+VCOS_INLINE_IMPL
+void vcos_tls_delete(VCOS_TLS_KEY_T tls) {
+ vcos_generic_tls_delete(tls);
+}
+
+#undef VCOS_ASSERT_LOGGING_DISABLE
+#define VCOS_ASSERT_LOGGING_DISABLE 0
+
+#endif /* VCOS_INLINE_BODIES */
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_joinable_thread_from_plain.h
@@ -0,0 +1,202 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - implementation: joinable thread from plain
+=============================================================================*/
+
+/** \file
+ *
+ * Header file for platforms creating the joinable thread from a lowlevel
+ * thread.
+ *
+ * In addition to the actual thread, the following are also created:
+ *
+ * - a semaphore to wait on when joining the thread
+ * - a semaphore to support counted suspend/resume (used by event group)
+ * - a per-thread timer (used by event group, but could be removed)
+ */
+
+#ifndef VCOS_JOINABLE_THREAD_FROM_PLAIN_H
+#define VCOS_JOINABLE_THREAD_FROM_PLAIN_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_semaphore.h"
+#include "interface/vcos/vcos_lowlevel_thread.h"
+#include "interface/vcos/vcos_timer.h"
+
+#ifdef VCOS_WANT_TLS_EMULATION
+#include "interface/vcos/generic/vcos_generic_tls.h"
+#endif
+
+#define VCOS_THREAD_MAGIC 0x56436a74
+
+#define VCOS_THREAD_VALID(t) (t->magic == VCOS_THREAD_MAGIC)
+#define VCOS_HAVE_THREAD_AT_EXIT 1
+
+/** Thread attribute structure. Clients should not manipulate this directly, but
+ * should instead use the provided functions.
+ */
+typedef struct VCOS_THREAD_ATTR_T
+{
+ void *ta_stackaddr;
+ VCOS_UNSIGNED ta_stacksz;
+ VCOS_UNSIGNED ta_priority;
+ VCOS_UNSIGNED ta_affinity;
+ VCOS_UNSIGNED ta_timeslice;
+ VCOS_UNSIGNED legacy;
+ VCOS_UNSIGNED ta_autostart;
+} VCOS_THREAD_ATTR_T;
+
+/** Each thread gets a timer, which is for internal VCOS use.
+ */
+typedef struct _VCOS_THREAD_TIMER_T
+{
+ VCOS_TIMER_T timer;
+ void (*pfn)(void *);
+ void *cxt;
+} _VCOS_THREAD_TIMER_T;
+
+typedef void (*VCOS_THREAD_EXIT_HANDLER_T)(void *);
+/** Called at thread exit.
+ */
+typedef struct VCOS_THREAD_EXIT_T
+{
+ VCOS_THREAD_EXIT_HANDLER_T pfn;
+ void *cxt;
+} VCOS_THREAD_EXIT_T;
+#define VCOS_MAX_EXIT_HANDLERS 8
+
+/* The name field isn't used for anything, so we can just copy the
+ * the pointer. Nucleus makes its own copy.
+ */
+typedef const char * VCOS_LLTHREAD_T_NAME;
+#define _VCOS_LLTHREAD_NAME(dst,src) (dst)=(src)
+
+/*
+ * Simulated TLS support
+ */
+
+
+/** Thread structure.
+ *
+ * \warning Do not access the members of this structure directly!
+ */
+typedef struct VCOS_THREAD_T
+{
+ VCOS_LLTHREAD_T thread; /**< The underlying thread */
+ char name[16]; /**< The name */
+ unsigned int magic; /**< For debug */
+ void *exit_data; /**< Exit data passed out in vcos_joinable_thread_exit() */
+ void *stack; /**< Stack, if not supplied by caller */
+ VCOS_SEMAPHORE_T wait; /**< Semaphore to wait on at join */
+ VCOS_SEMAPHORE_T suspend; /**< Semaphore to wait on for counted suspend */
+ int16_t joined; /**< Joined yet? For debug. */
+ VCOS_UNSIGNED legacy; /**< Use (argc,argv) for entry point arguments */
+ void *(*entry)(void*); /**< Entry point */
+ void *arg; /**< Argument passed to entry point */
+ void *(*term)(void*); /**< Termination function, used by reaper */
+ void *term_arg; /**< Argument passed to termination function */
+ _VCOS_THREAD_TIMER_T _timer; /**< Internal timer, mainly for event groups */
+#ifdef VCOS_WANT_TLS_EMULATION
+ VCOS_TLS_THREAD_T _tls; /**< TLS data when native TLS not available, or NULL */
+#endif
+ /** Array of functions to call at thread exit */
+ VCOS_THREAD_EXIT_T at_exit[VCOS_MAX_EXIT_HANDLERS];
+
+ struct VCOS_THREAD_T *next; /**< For linked lists of threads */
+} VCOS_THREAD_T;
+
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_setstack(VCOS_THREAD_ATTR_T *attrs, void *addr, VCOS_UNSIGNED stacksz) {
+ attrs->ta_stackaddr = addr;
+ attrs->ta_stacksz = stacksz;
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_setstacksize(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED stacksz) {
+ attrs->ta_stacksz = stacksz;
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_setpriority(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED pri) {
+ attrs->ta_priority = pri;
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_setaffinity(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED affinity) {
+ attrs->ta_affinity = affinity;
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_settimeslice(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED ts) {
+ attrs->ta_timeslice = ts;
+}
+
+VCOS_INLINE_IMPL
+void _vcos_thread_attr_setlegacyapi(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED legacy) {
+ attrs->legacy = legacy;
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_attr_setautostart(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED autostart) {
+ attrs->ta_autostart = autostart;
+}
+
+VCOS_INLINE_IMPL
+VCOS_THREAD_T *vcos_thread_current(void) {
+ VCOS_THREAD_T *ret = (VCOS_THREAD_T*)vcos_llthread_current();
+ /*If we're called from a non-vcos thread, this assert will fail.
+ *XXX FIXME why is this commented out?
+ *vcos_assert(ret->magic == VCOS_THREAD_MAGIC);
+ */
+ return ret;
+}
+
+VCOS_INLINE_IMPL
+int vcos_thread_running(VCOS_THREAD_T *thread) {
+ return vcos_llthread_running(&thread->thread);
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_resume(VCOS_THREAD_T *thread) {
+ vcos_llthread_resume(&thread->thread);
+}
+
+#endif /* VCOS_INLINE_BODIES */
+
+/**
+ * \brief Create a VCOS_THREAD_T for the current thread. This is so we can have
+ * VCOS_THREAD_Ts even for threads not originally created by VCOS (eg the
+ * thread that calls vcos_init)
+ */
+extern VCOS_STATUS_T _vcos_thread_create_attach(VCOS_THREAD_T *thread,
+ const char *name);
+
+/**
+ * \brief Deletes the VCOS_THREAD_T, but does not wait for the underlying
+ * thread to exit. This will cleanup everything created by
+ * _vcos_thread_create_attach
+ */
+extern void _vcos_thread_delete(VCOS_THREAD_T *thread);
+
+/** Register a function to be called when the current thread exits.
+ */
+extern VCOS_STATUS_T vcos_thread_at_exit(void (*pfn)(void*), void *cxt);
+
+/** Deregister a previously registered at-exit function.
+ */
+extern void vcos_thread_deregister_at_exit(void (*pfn)(void*), void *cxt);
+
+#ifdef __cplusplus
+}
+#endif
+#endif /* VCOS_JOINABLE_THREAD_FROM_PLAIN_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_latch_from_sem.h
@@ -0,0 +1,48 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - Construct a latch from a semaphore
+=============================================================================*/
+
+/** FIXME: rename to vcos_mutex_from_sem.c
+ */
+
+typedef struct VCOS_MUTEX_T {
+ VCOS_SEMAPHORE_T sem;
+ struct VCOS_THREAD_T *owner;
+} VCOS_MUTEX_T;
+
+extern VCOS_STATUS_T vcos_generic_mutex_create(VCOS_MUTEX_T *latch, const char *name);
+extern void vcos_generic_mutex_delete(VCOS_MUTEX_T *latch);
+extern VCOS_STATUS_T vcos_generic_mutex_lock(VCOS_MUTEX_T *latch);
+extern void vcos_generic_mutex_unlock(VCOS_MUTEX_T *latch);
+
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_mutex_create(VCOS_MUTEX_T *latch, const char *name) {
+ return vcos_generic_mutex_create(latch,name);
+}
+
+VCOS_INLINE_IMPL
+void vcos_mutex_delete(VCOS_MUTEX_T *latch) {
+ vcos_generic_mutex_delete(latch);
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_mutex_lock(VCOS_MUTEX_T *latch) {
+ return vcos_generic_mutex_lock(latch);
+}
+
+VCOS_INLINE_IMPL
+void vcos_mutex_unlock(VCOS_MUTEX_T *latch) {
+ vcos_generic_mutex_unlock(latch);
+}
+
+#endif /* VCOS_INLINE_BODIES */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_logcat.c
@@ -0,0 +1,549 @@
+/*=============================================================================
+Copyright (c) 2010 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+Categorized logging for VCOS - a generic implementation.
+=============================================================================*/
+
+#include "interface/vcos/vcos.h"
+#include "interface/vcos/vcos_ctype.h"
+#include "interface/vcos/vcos_string.h"
+
+static VCOS_MUTEX_T lock;
+static int warned_loglevel; /* only warn about invalid log level once */
+static VCOS_VLOG_IMPL_FUNC_T vcos_vlog_impl_func = vcos_vlog_default_impl;
+
+#define VCOS_LOG_CATEGORY (&dflt_log_category)
+static VCOS_LOG_CAT_T dflt_log_category;
+VCOS_LOG_CAT_T *vcos_logging_categories = NULL;
+static int inited;
+
+#if VCOS_HAVE_CMD
+
+/*
+ * For kernel or videocore purposes, we generally want the log command. For
+ * user-space apps, they might want to provide their own log command, so we
+ * don't include the built in on.
+ *
+ * So pthreads/vcos_platform.h defines VCOS_WANT_LOG_CMD to be 0. It is
+ * undefined elsewhere.
+ */
+
+# if !defined( VCOS_WANT_LOG_CMD )
+# define VCOS_WANT_LOG_CMD 1
+# endif
+#else
+# define VCOS_WANT_LOG_CMD 0
+#endif
+
+#if VCOS_WANT_LOG_CMD
+
+/*****************************************************************************
+*
+* Does a vcos_assert(0), which is useful to test logging.
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_log_assert_cmd( VCOS_CMD_PARAM_T *param )
+{
+ (void)param;
+
+#if defined( NDEBUG ) && !defined( VCOS_RELEASE_ASSERTS )
+ vcos_log_error( "vcos_asserts have been compiled out" );
+ vcos_cmd_printf( param, "vcos_asserts have been compiled out - did a vcos_log_error instead\n" );
+#else
+ vcos_assert(0);
+ vcos_cmd_printf( param, "Executed vcos_assert(0)\n" );
+#endif
+
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* Sets a vcos logging level
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_log_set_cmd( VCOS_CMD_PARAM_T *param )
+{
+ VCOS_LOG_CAT_T *cat;
+ char *name;
+ char *levelStr;
+ VCOS_LOG_LEVEL_T level;
+ VCOS_STATUS_T status;
+
+ if ( param->argc != 3 )
+ {
+ vcos_cmd_usage( param );
+ return VCOS_EINVAL;
+ }
+
+ name = param->argv[1];
+ levelStr = param->argv[2];
+
+ if ( vcos_string_to_log_level( levelStr, &level ) != VCOS_SUCCESS )
+ {
+ vcos_cmd_printf( param, "Unrecognized logging level: '%s'\n", levelStr );
+ return VCOS_EINVAL;
+ }
+
+ vcos_mutex_lock(&lock);
+
+ status = VCOS_SUCCESS;
+ for ( cat = vcos_logging_categories; cat != NULL; cat = cat->next )
+ {
+ if ( vcos_strcmp( name, cat->name ) == 0 )
+ {
+ cat->level = level;
+ vcos_cmd_printf( param, "Category %s level set to %s\n", name, levelStr );
+ break;
+ }
+ }
+ if ( cat == NULL )
+ {
+ vcos_cmd_printf( param, "Unrecognized category: '%s'\n", name );
+ status = VCOS_ENOENT;
+ }
+
+ vcos_mutex_unlock(&lock);
+
+ return status;
+}
+
+/*****************************************************************************
+*
+* Prints out the current settings for a given category (or all cvategories)
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_log_status_cmd( VCOS_CMD_PARAM_T *param )
+{
+ VCOS_LOG_CAT_T *cat;
+ VCOS_STATUS_T status;
+
+ vcos_mutex_lock(&lock);
+
+ if ( param->argc == 1)
+ {
+ int nw;
+ int nameWidth = 0;
+
+ /* Print information about all of the categories. */
+
+ for ( cat = vcos_logging_categories; cat != NULL; cat = cat->next )
+ {
+ nw = (int)strlen( cat->name );
+
+ if ( nw > nameWidth )
+ {
+ nameWidth = nw;
+ }
+ }
+
+ for ( cat = vcos_logging_categories; cat != NULL; cat = cat->next )
+ {
+ vcos_cmd_printf( param, "%-*s - %s\n", nameWidth, cat->name, vcos_log_level_to_string( cat->level ));
+ }
+ }
+ else
+ {
+ /* Print information about a particular category */
+
+ for ( cat = vcos_logging_categories; cat != NULL; cat = cat->next )
+ {
+ if ( vcos_strcmp( cat->name, param->argv[1] ) == 0 )
+ {
+ vcos_cmd_printf( param, "%s - %s\n", cat->name, vcos_log_level_to_string( cat->level ));
+ break;
+ }
+ }
+ if ( cat == NULL )
+ {
+ vcos_cmd_printf( param, "Unrecognized logging category: '%s'\n", param->argv[1] );
+ status = VCOS_ENOENT;
+ goto out;
+ }
+ }
+
+ status = VCOS_SUCCESS;
+out:
+ vcos_mutex_unlock(&lock);
+
+ return status;
+}
+
+/*****************************************************************************
+*
+* Prints out the current settings for a given category (or all cvategories)
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_log_test_cmd( VCOS_CMD_PARAM_T *param )
+{
+ if ( param->argc == 1 )
+ {
+ static int seq_num = 100;
+
+ /* No additional arguments - generate a message with an incrementing number */
+
+ vcos_log_error( "Test message %d", seq_num );
+
+ seq_num++;
+ vcos_cmd_printf( param, "Logged 'Test message %d'\n", seq_num );
+ }
+ else
+ {
+ int arg_idx;
+
+ /* Arguments supplied - log these */
+
+ for ( arg_idx = 0; arg_idx < param->argc; arg_idx++ )
+ {
+ vcos_log_error( "argv[%d] = '%s'", arg_idx, param->argv[arg_idx] );
+ }
+ vcos_cmd_printf( param, "Logged %d line(s) of test data\n", param->argc );
+ }
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* Internal commands
+*
+*****************************************************************************/
+
+static VCOS_CMD_T log_cmd_entry[] =
+{
+ { "assert", "", vcos_log_assert_cmd, NULL, "Does a vcos_assert(0) to test logging" },
+ { "set", "category level", vcos_log_set_cmd, NULL, "Sets the vcos logging level for a category" },
+ { "status", "[category]", vcos_log_status_cmd, NULL, "Prints the vcos log status for a (or all) categories" },
+ { "test", "[arbitrary text]", vcos_log_test_cmd, NULL, "Does a vcos_log to test logging" },
+
+ { NULL, NULL, NULL, NULL, NULL }
+};
+
+static VCOS_CMD_T cmd_log =
+ { "log", "command [args]", NULL, log_cmd_entry, "Commands related to vcos logging" };
+
+#endif
+
+void vcos_logging_init(void)
+{
+ if (inited)
+ {
+ /* FIXME: should print a warning or something here */
+ return;
+ }
+ vcos_mutex_create(&lock, "vcos_log");
+
+ vcos_log_platform_init();
+
+ vcos_log_register("default", &dflt_log_category);
+
+#if VCOS_WANT_LOG_CMD
+ vcos_cmd_register( &cmd_log );
+#endif
+
+ vcos_assert(!inited);
+ inited = 1;
+}
+
+/** Read an alphanumeric token, returning True if we succeeded.
+ */
+
+static int read_tok(char *tok, size_t toklen, const char **pstr, char sep)
+{
+ const char *str = *pstr;
+ size_t n = 0;
+ char ch;
+
+ /* skip past any whitespace */
+ while (str[0] && isspace((int)(str[0])))
+ str++;
+
+ while ((ch = *str) != '\0' &&
+ ch != sep &&
+ (isalnum((int)ch) || (ch == '_')) &&
+ n != toklen-1)
+ {
+ tok[n++] = ch;
+ str++;
+ }
+
+ /* did it work out? */
+ if (ch == '\0' || ch == sep)
+ {
+ if (ch) str++; /* move to next token if not at end */
+ /* yes */
+ tok[n] = '\0';
+ *pstr = str;
+ return 1;
+ }
+ else
+ {
+ /* no */
+ return 0;
+ }
+}
+
+const char *vcos_log_level_to_string( VCOS_LOG_LEVEL_T level )
+{
+ switch (level)
+ {
+ case VCOS_LOG_UNINITIALIZED: return "uninit";
+ case VCOS_LOG_NEVER: return "never";
+ case VCOS_LOG_ERROR: return "error";
+ case VCOS_LOG_WARN: return "warn";
+ case VCOS_LOG_INFO: return "info";
+ case VCOS_LOG_TRACE: return "trace";
+ }
+ return "???";
+}
+
+VCOS_STATUS_T vcos_string_to_log_level( const char *str, VCOS_LOG_LEVEL_T *level )
+{
+ if (strcmp(str,"error") == 0)
+ *level = VCOS_LOG_ERROR;
+ else if (strcmp(str,"never") == 0)
+ *level = VCOS_LOG_NEVER;
+ else if (strcmp(str,"warn") == 0)
+ *level = VCOS_LOG_WARN;
+ else if (strcmp(str,"warning") == 0)
+ *level = VCOS_LOG_WARN;
+ else if (strcmp(str,"info") == 0)
+ *level = VCOS_LOG_INFO;
+ else if (strcmp(str,"trace") == 0)
+ *level = VCOS_LOG_TRACE;
+ else
+ return VCOS_EINVAL;
+
+ return VCOS_SUCCESS;
+}
+
+static int read_level(VCOS_LOG_LEVEL_T *level, const char **pstr, char sep)
+{
+ char buf[16];
+ int ret = 1;
+ if (read_tok(buf,sizeof(buf),pstr,sep))
+ {
+ if (vcos_string_to_log_level(buf,level) != VCOS_SUCCESS)
+ {
+ vcos_log("Invalid trace level '%s'\n", buf);
+ ret = 0;
+ }
+ }
+ else
+ {
+ ret = 0;
+ }
+ return ret;
+}
+
+void vcos_log_register(const char *name, VCOS_LOG_CAT_T *category)
+{
+ const char *env;
+ VCOS_LOG_CAT_T *i;
+
+ category->name = name;
+ if ( category->level == VCOS_LOG_UNINITIALIZED )
+ {
+ category->level = VCOS_LOG_ERROR;
+ }
+ category->flags.want_prefix = (category != &dflt_log_category );
+
+ vcos_mutex_lock(&lock);
+
+ /* is it already registered? */
+ for (i = vcos_logging_categories; i ; i = i->next )
+ {
+ if (i == category)
+ {
+ i->refcount++;
+ break;
+ }
+ }
+
+ if (!i)
+ {
+ /* not yet registered */
+ category->next = vcos_logging_categories;
+ vcos_logging_categories = category;
+ category->refcount++;
+
+ vcos_log_platform_register(category);
+ }
+
+ vcos_mutex_unlock(&lock);
+
+ /* Check to see if this log level has been enabled. Look for
+ * (<category:level>,)*
+ *
+ * VC_LOGLEVEL=ilcs:info,vchiq:warn
+ */
+
+ env = _VCOS_LOG_LEVEL();
+ if (env)
+ {
+ do
+ {
+ char env_name[64];
+ VCOS_LOG_LEVEL_T level;
+ if (read_tok(env_name, sizeof(env_name), &env, ':') &&
+ read_level(&level, &env, ','))
+ {
+ if (strcmp(env_name, name) == 0)
+ {
+ category->level = level;
+ break;
+ }
+ }
+ else
+ {
+ if (!warned_loglevel)
+ {
+ vcos_log("VC_LOGLEVEL format invalid at %s\n", env);
+ warned_loglevel = 1;
+ }
+ return;
+ }
+ } while (env[0] != '\0');
+ }
+
+ vcos_log_info( "Registered log category '%s' with level %s",
+ category->name,
+ vcos_log_level_to_string( category->level ));
+}
+
+void vcos_log_unregister(VCOS_LOG_CAT_T *category)
+{
+ VCOS_LOG_CAT_T **pcat;
+ vcos_mutex_lock(&lock);
+ category->refcount--;
+ if (category->refcount == 0)
+ {
+ pcat = &vcos_logging_categories;
+ while (*pcat != category)
+ {
+ if (!*pcat)
+ break; /* possibly deregistered twice? */
+ if ((*pcat)->next == NULL)
+ {
+ vcos_assert(0); /* already removed! */
+ vcos_mutex_unlock(&lock);
+ return;
+ }
+ pcat = &(*pcat)->next;
+ }
+ if (*pcat)
+ *pcat = category->next;
+
+ vcos_log_platform_unregister(category);
+ }
+ vcos_mutex_unlock(&lock);
+}
+
+VCOSPRE_ const VCOS_LOG_CAT_T * VCOSPOST_ vcos_log_get_default_category(void)
+{
+ return &dflt_log_category;
+}
+
+void vcos_set_log_options(const char *opt)
+{
+ (void)opt;
+}
+
+void vcos_log_dump_mem_impl( const VCOS_LOG_CAT_T *cat,
+ const char *label,
+ uint32_t addr,
+ const void *voidMem,
+ size_t numBytes )
+{
+ const uint8_t *mem = (const uint8_t *)voidMem;
+ size_t offset;
+ char lineBuf[ 100 ];
+ char *s;
+
+ while ( numBytes > 0 )
+ {
+ s = lineBuf;
+
+ for ( offset = 0; offset < 16; offset++ )
+ {
+ if ( offset < numBytes )
+ {
+ s += vcos_snprintf( s, 4, "%02x ", mem[ offset ]);
+ }
+ else
+ {
+ s += vcos_snprintf( s, 4, " " );
+ }
+ }
+
+ for ( offset = 0; offset < 16; offset++ )
+ {
+ if ( offset < numBytes )
+ {
+ uint8_t ch = mem[ offset ];
+
+ if (( ch < ' ' ) || ( ch > '~' ))
+ {
+ ch = '.';
+ }
+ *s++ = (char)ch;
+ }
+ }
+ *s++ = '\0';
+
+ if (( label != NULL ) && ( *label != '\0' ))
+ {
+ vcos_log_impl( cat, VCOS_LOG_INFO, "%s: %08x: %s", label, addr, lineBuf );
+ }
+ else
+ {
+ vcos_log_impl( cat, VCOS_LOG_INFO, "%08x: %s", addr, lineBuf );
+ }
+
+ addr += 16;
+ mem += 16;
+ if ( numBytes > 16 )
+ {
+ numBytes -= 16;
+ }
+ else
+ {
+ numBytes = 0;
+ }
+ }
+
+}
+
+void vcos_log_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, ...)
+{
+ va_list ap;
+ va_start(ap,fmt);
+ vcos_vlog_impl( cat, _level, fmt, ap );
+ va_end(ap);
+}
+
+void vcos_vlog_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, va_list args)
+{
+ vcos_vlog_impl_func( cat, _level, fmt, args );
+}
+
+void vcos_set_vlog_impl( VCOS_VLOG_IMPL_FUNC_T vlog_impl_func )
+{
+ if ( vlog_impl_func == NULL )
+ {
+ vcos_vlog_impl_func = vcos_vlog_default_impl;
+ }
+ else
+ {
+ vcos_vlog_impl_func = vlog_impl_func;
+ }
+}
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_mem_from_malloc.c
@@ -0,0 +1,73 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - memory alloc implementation
+=============================================================================*/
+
+#include "interface/vcos/vcos.h"
+
+#ifndef _vcos_platform_malloc
+#include <stdlib.h>
+#define _vcos_platform_malloc malloc
+#define _vcos_platform_free free
+#endif
+
+typedef struct malloc_header_s {
+ uint32_t guardword;
+ uint32_t size;
+ const char *description;
+ void *ptr;
+} MALLOC_HEADER_T;
+
+
+#define MIN_ALIGN sizeof(MALLOC_HEADER_T)
+
+#define GUARDWORDHEAP 0xa55a5aa5
+
+void *vcos_generic_mem_alloc_aligned(VCOS_UNSIGNED size, VCOS_UNSIGNED align, const char *desc)
+{
+ int local_align = align == 0 ? 1 : align;
+ int required_size = size + local_align + sizeof(MALLOC_HEADER_T);
+ void *ptr = _vcos_platform_malloc(required_size);
+ void *ret = (void *)VCOS_ALIGN_UP(((char *)ptr)+sizeof(MALLOC_HEADER_T), local_align);
+ MALLOC_HEADER_T *h = ((MALLOC_HEADER_T *)ret)-1;
+
+ h->size = size;
+ h->description = desc;
+ h->guardword = GUARDWORDHEAP;
+ h->ptr = ptr;
+
+ return ret;
+}
+
+void *vcos_generic_mem_alloc(VCOS_UNSIGNED size, const char *desc)
+{
+ return vcos_generic_mem_alloc_aligned(size,MIN_ALIGN,desc);
+}
+
+void *vcos_generic_mem_calloc(VCOS_UNSIGNED count, VCOS_UNSIGNED sz, const char *desc)
+{
+ uint32_t size = count*sz;
+ void *ptr = vcos_generic_mem_alloc_aligned(size,MIN_ALIGN,desc);
+ if (ptr)
+ {
+ memset(ptr, 0, size);
+ }
+ return ptr;
+}
+
+void vcos_generic_mem_free(void *ptr)
+{
+ MALLOC_HEADER_T *h;
+ if (! ptr) return;
+
+ h = ((MALLOC_HEADER_T *)ptr)-1;
+ vcos_assert(h->guardword == GUARDWORDHEAP);
+ _vcos_platform_free(h->ptr);
+}
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_mem_from_malloc.h
@@ -0,0 +1,54 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : VMCS Host Apps
+Module : Framework - VMCS
+
+FILE DESCRIPTION
+Create the vcos_malloc API from the regular system malloc/free
+=============================================================================*/
+
+/**
+ * \file
+ *
+ * Create the vcos malloc API from a regular system malloc/free library.
+ *
+ * The API lets callers specify an alignment.
+ *
+ * Under VideoCore this is not needed, as we can simply use the rtos_malloc routines.
+ * But on host platforms that won't be the case.
+ *
+ */
+
+VCOSPRE_ void * VCOSPOST_ vcos_generic_mem_alloc(VCOS_UNSIGNED sz, const char *desc);
+VCOSPRE_ void * VCOSPOST_ vcos_generic_mem_calloc(VCOS_UNSIGNED count, VCOS_UNSIGNED sz, const char *descr);
+VCOSPRE_ void VCOSPOST_ vcos_generic_mem_free(void *ptr);
+VCOSPRE_ void * VCOSPOST_ vcos_generic_mem_alloc_aligned(VCOS_UNSIGNED sz, VCOS_UNSIGNED align, const char *desc);
+
+#ifdef VCOS_INLINE_BODIES
+
+VCOS_INLINE_IMPL
+void *vcos_malloc(VCOS_UNSIGNED size, const char *description) {
+ return vcos_generic_mem_alloc(size, description);
+}
+
+VCOS_INLINE_IMPL
+void *vcos_calloc(VCOS_UNSIGNED num, VCOS_UNSIGNED size, const char *description) {
+ return vcos_generic_mem_calloc(num, size, description);
+}
+
+VCOS_INLINE_IMPL
+void vcos_free(void *ptr) {
+ vcos_generic_mem_free(ptr);
+}
+
+VCOS_INLINE_IMPL
+void * vcos_malloc_aligned(VCOS_UNSIGNED size, VCOS_UNSIGNED align, const char *description) {
+ return vcos_generic_mem_alloc_aligned(size, align, description);
+}
+
+
+#endif /* VCOS_INLINE_BODIES */
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_mutexes_are_reentrant.h
@@ -0,0 +1,68 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - reentrant mutexes mapped directly to regular ones
+=============================================================================*/
+
+#ifndef VCOS_GENERIC_REENTRANT_MUTEX_H
+#define VCOS_GENERIC_REENTRANT_MUTEX_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "interface/vcos/vcos_mutex.h"
+
+/**
+ * \file
+ *
+ * Reentrant Mutexes directly using the native re-entrant mutex.
+ *
+ */
+
+typedef VCOS_MUTEX_T VCOS_REENTRANT_MUTEX_T;
+
+/* Inline forwarding functions */
+
+#if defined(VCOS_INLINE_BODIES)
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_reentrant_mutex_create(VCOS_REENTRANT_MUTEX_T *m, const char *name) {
+ return vcos_mutex_create(m,name);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_delete(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_mutex_delete(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_lock(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_mutex_lock(m);
+}
+
+VCOS_INLINE_IMPL
+void vcos_reentrant_mutex_unlock(VCOS_REENTRANT_MUTEX_T *m) {
+ vcos_mutex_unlock(m);
+}
+
+VCOS_INLINE_IMPL
+int vcos_reentrant_mutex_is_locked(VCOS_REENTRANT_MUTEX_T *m) {
+ return vcos_mutex_is_locked(m);
+}
+
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/generic/vcos_thread_reaper.h
@@ -0,0 +1,35 @@
+/*=============================================================================
+Copyright (c) 2010 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - thread reaping
+=============================================================================*/
+
+#ifndef VCOS_THREAD_REAPER_H
+#define VCOS_THREAD_REAPER_H
+
+#define VCOS_HAVE_THREAD_REAPER
+
+/** Initialise the thread reaper.
+ */
+VCOS_STATUS_T vcos_thread_reaper_init(void);
+
+/** Reap a thread. Arranges for the thread to be automatically
+ * joined.
+ *
+ * @sa vcos_thread_join().
+ *
+ * @param thread the thread to terminate
+ * @param on_terminated called after the thread has exited
+ * @param cxt pass back to the callback
+ *
+ */
+void vcos_thread_reap(VCOS_THREAD_T *thread, void (*on_terminated)(void*), void *cxt);
+
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/stdint.h
@@ -0,0 +1,17 @@
+/*=============================================================================
+Copyright (c) 2010 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+VideoCore OS fAbstraction Layer - stdint.h C standard header
+=============================================================================*/
+
+#ifndef _VCOS_PLATFORM_LINUX_STDINT_H
+#define _VCOS_PLATFORM_LINUX_STDINT_H
+
+/* The Linux kernel does not have a <stdint.h> so we have to provide one of
+ our own. */
+
+#include <linux/types.h> /* includes integer types */
+
+#endif /* _VCOS_PLATFORM_LINUX_STDINT_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel.c
@@ -0,0 +1,616 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - pthreads types
+=============================================================================*/
+
+#define VCOS_INLINE_BODIES
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/time.h>
+#include <linux/pid.h>
+#include <linux/mm.h>
+#include <linux/version.h>
+
+#if defined( CONFIG_BCM_KNLLOG_SUPPORT )
+#include <linux/broadcom/knllog.h>
+#endif
+#include "interface/vcos/vcos.h"
+#ifdef HAVE_VCOS_VERSION
+#include "interface/vcos/vcos_build_info.h"
+#endif
+
+VCOS_CFG_ENTRY_T vcos_cfg_dir;
+VCOS_CFG_ENTRY_T vcos_logging_cfg_dir;
+VCOS_CFG_ENTRY_T vcos_version_cfg;
+
+#ifndef VCOS_DEFAULT_STACK_SIZE
+#define VCOS_DEFAULT_STACK_SIZE 4096
+#endif
+
+static VCOS_THREAD_ATTR_T default_attrs = {
+ 0,
+ VCOS_DEFAULT_STACK_SIZE,
+};
+
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,36)
+static DEFINE_SEMAPHORE(lock);
+#else
+static DECLARE_MUTEX(lock);
+#endif
+
+typedef void (*LEGACY_ENTRY_FN_T)(int, void *);
+
+/** Wrapper function around the real thread function. Posts the semaphore
+ * when completed.
+ */
+static int vcos_thread_wrapper(void *arg)
+{
+ void *ret;
+ VCOS_THREAD_T *thread = arg;
+
+ vcos_assert(thread->magic == VCOS_THREAD_MAGIC);
+
+ thread->thread.thread = current;
+
+ vcos_add_thread(thread);
+
+#ifdef VCOS_WANT_TLS_EMULATION
+ vcos_tls_thread_register(&thread->_tls);
+#endif
+
+ if (thread->legacy)
+ {
+ LEGACY_ENTRY_FN_T fn = (LEGACY_ENTRY_FN_T)thread->entry;
+ fn(0,thread->arg);
+ ret = 0;
+ }
+ else
+ {
+ ret = thread->entry(thread->arg);
+ }
+
+ thread->exit_data = ret;
+
+ vcos_remove_thread(current);
+
+ /* For join and cleanup */
+ vcos_semaphore_post(&thread->wait);
+
+ return 0;
+}
+
+VCOS_STATUS_T vcos_thread_create(VCOS_THREAD_T *thread,
+ const char *name,
+ VCOS_THREAD_ATTR_T *attrs,
+ VCOS_THREAD_ENTRY_FN_T entry,
+ void *arg)
+{
+ VCOS_STATUS_T st;
+ struct task_struct *kthread;
+
+ memset(thread, 0, sizeof(*thread));
+ thread->magic = VCOS_THREAD_MAGIC;
+ strlcpy( thread->name, name, sizeof( thread->name ));
+ thread->legacy = attrs ? attrs->legacy : 0;
+ thread->entry = entry;
+ thread->arg = arg;
+
+ if (!name)
+ {
+ vcos_assert(0);
+ return VCOS_EINVAL;
+ }
+
+ st = vcos_semaphore_create(&thread->wait, NULL, 0);
+ if (st != VCOS_SUCCESS)
+ {
+ return st;
+ }
+
+ st = vcos_semaphore_create(&thread->suspend, NULL, 0);
+ if (st != VCOS_SUCCESS)
+ {
+ return st;
+ }
+
+ /*required for event groups */
+ vcos_timer_create(&thread->_timer.timer, thread->name, NULL, NULL);
+
+ kthread = kthread_create((int (*)(void *))vcos_thread_wrapper, (void*)thread, name);
+ vcos_assert(kthread != NULL);
+ set_user_nice(kthread, attrs->ta_priority);
+ thread->thread.thread = kthread;
+ wake_up_process(kthread);
+ return VCOS_SUCCESS;
+}
+
+void vcos_thread_join(VCOS_THREAD_T *thread,
+ void **pData)
+{
+ vcos_assert(thread);
+ vcos_assert(thread->magic == VCOS_THREAD_MAGIC);
+
+ thread->joined = 1;
+
+ vcos_semaphore_wait(&thread->wait);
+
+ if (pData)
+ {
+ *pData = thread->exit_data;
+ }
+
+ /* Clean up */
+ if (thread->stack)
+ vcos_free(thread->stack);
+
+ vcos_semaphore_delete(&thread->wait);
+ vcos_semaphore_delete(&thread->suspend);
+
+}
+
+uint32_t vcos_getmicrosecs( void )
+{
+ struct timeval tv;
+/*XXX FIX ME! switch to ktime_get_ts to use MONOTONIC clock */
+ do_gettimeofday(&tv);
+ return (tv.tv_sec*1000000) + tv.tv_usec;
+}
+
+VCOS_STATUS_T vcos_timer_init(void)
+{
+ return VCOS_SUCCESS;
+}
+
+static const char *log_prefix[] =
+{
+ "", /* VCOS_LOG_UNINITIALIZED */
+ "", /* VCOS_LOG_NEVER */
+ KERN_ERR, /* VCOS_LOG_ERROR */
+ KERN_WARNING, /* VCOS_LOG_WARN */
+ KERN_INFO, /* VCOS_LOG_INFO */
+ KERN_INFO /* VCOS_LOG_TRACE */
+};
+
+void vcos_vlog_default_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, va_list args)
+{
+ char *newline = strchr( fmt, '\n' );
+ const char *prefix;
+ const char *real_fmt;
+
+ preempt_disable();
+ {
+ if ( *fmt == '<' )
+ {
+ prefix = fmt;
+ real_fmt= &fmt[3];
+ }
+ else
+ {
+ prefix = log_prefix[_level];
+ real_fmt = fmt;
+ }
+#if defined( CONFIG_BCM_KNLLOG_SUPPORT )
+ knllog_ventry( "vcos", real_fmt, args );
+#endif
+ printk( "%.3svcos: [%d]: ", prefix, current->pid );
+ vprintk( real_fmt, args );
+
+ if ( newline == NULL )
+ {
+ printk("\n");
+ }
+ }
+ preempt_enable();
+}
+
+
+const char * _vcos_log_level(void)
+{
+ return NULL;
+}
+
+/*****************************************************************************
+*
+* Displays the version information in /proc/vcos/version
+*
+*****************************************************************************/
+
+#ifdef HAVE_VCOS_VERSION
+
+static void show_version( VCOS_CFG_BUF_T buf, void *data )
+{
+ static const char* copyright = "Copyright (c) 2011 Broadcom";
+
+ vcos_cfg_buf_printf( buf, "Built %s %s on %s\n%s\nversion %s\n",
+ vcos_get_build_date(),
+ vcos_get_build_time(),
+ vcos_get_build_hostname(),
+ copyright,
+ vcos_get_build_version() );
+}
+
+#endif
+
+/*****************************************************************************
+*
+* Initialises vcos
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_init(void)
+{
+ if ( vcos_cfg_mkdir( &vcos_cfg_dir, NULL, "vcos" ) != VCOS_SUCCESS )
+ {
+ printk( KERN_ERR "%s: Unable to create vcos cfg entry\n", __func__ );
+ }
+ vcos_logging_init();
+
+#ifdef HAVE_VCOS_VERSION
+ if ( vcos_cfg_create_entry( &vcos_version_cfg, &vcos_cfg_dir, "version",
+ show_version, NULL, NULL ) != VCOS_SUCCESS )
+ {
+ printk( KERN_ERR "%s: Unable to create vcos cfg entry 'version'\n", __func__ );
+ }
+#endif
+
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* Deinitializes vcos
+*
+*****************************************************************************/
+
+void vcos_deinit(void)
+{
+#ifdef HAVE_VCOS_VERSION
+ vcos_cfg_remove_entry( &vcos_version_cfg );
+#endif
+ vcos_cfg_remove_entry( &vcos_cfg_dir );
+}
+
+void vcos_global_lock(void)
+{
+ down(&lock);
+}
+
+void vcos_global_unlock(void)
+{
+ up(&lock);
+}
+
+/* vcos_thread_exit() doesn't really stop this thread here
+ *
+ * At the moment, call to do_exit() will leak task_struct for
+ * current thread, so we let the vcos_thread_wrapper() do the
+ * cleanup and exit job, and we return w/o actually stopping the thread.
+ *
+ * ToDo: Kernel v2.6.31 onwards, it is considered safe to call do_exit()
+ * from kthread, the implementation of which is combined in 2 patches
+ * with commit-ids "63706172" and "cdd140bd" in oss Linux kernel tree
+ */
+
+void vcos_thread_exit(void *arg)
+{
+ VCOS_THREAD_T *thread = vcos_thread_current();
+
+ vcos_assert(thread);
+ vcos_assert(thread->magic == VCOS_THREAD_MAGIC);
+
+ thread->exit_data = arg;
+}
+
+void vcos_thread_attr_init(VCOS_THREAD_ATTR_T *attrs)
+{
+ *attrs = default_attrs;
+}
+
+void _vcos_task_timer_set(void (*pfn)(void *), void *cxt, VCOS_UNSIGNED ms)
+{
+ VCOS_THREAD_T *self = vcos_thread_current();
+ vcos_assert(self);
+ vcos_assert(self->_timer.pfn == NULL);
+
+ vcos_timer_create( &self->_timer.timer, "TaskTimer", pfn, cxt );
+ vcos_timer_set(&self->_timer.timer, ms);
+}
+
+void _vcos_task_timer_cancel(void)
+{
+ VCOS_THREAD_T *self = vcos_thread_current();
+ if (self->_timer.timer.linux_timer.function)
+ {
+ vcos_timer_cancel(&self->_timer.timer);
+ vcos_timer_delete(&self->_timer.timer);
+ }
+}
+
+int vcos_vsnprintf( char *buf, size_t buflen, const char *fmt, va_list ap )
+{
+ return vsnprintf( buf, buflen, fmt, ap );
+}
+
+int vcos_snprintf(char *buf, size_t buflen, const char *fmt, ...)
+{
+ int ret;
+ va_list ap;
+ va_start(ap,fmt);
+ ret = vsnprintf(buf, buflen, fmt, ap);
+ va_end(ap);
+ return ret;
+}
+
+int vcos_llthread_running(VCOS_LLTHREAD_T *t) {
+ vcos_assert(0); /* this function only exists as a nasty hack for the video codecs! */
+ return 1;
+}
+
+static int vcos_verify_bkpts = 1;
+
+int vcos_verify_bkpts_enabled(void)
+{
+ return vcos_verify_bkpts;
+}
+
+/*****************************************************************************
+*
+* _vcos_log_platform_init is called from vcos_logging_init
+*
+*****************************************************************************/
+
+void _vcos_log_platform_init(void)
+{
+ if ( vcos_cfg_mkdir( &vcos_logging_cfg_dir, &vcos_cfg_dir, "logging" ) != VCOS_SUCCESS )
+ {
+ printk( KERN_ERR "%s: Unable to create logging cfg entry\n", __func__ );
+ }
+}
+
+/*****************************************************************************
+*
+* Called to display the contents of a logging category.
+*
+*****************************************************************************/
+
+static void logging_show_category( VCOS_CFG_BUF_T buf, void *data )
+{
+ VCOS_LOG_CAT_T *category = data;
+
+ vcos_cfg_buf_printf( buf, "%s\n", vcos_log_level_to_string( category->level ));
+}
+
+/*****************************************************************************
+*
+* Called to parse content for a logging category.
+*
+*****************************************************************************/
+
+static void logging_parse_category( VCOS_CFG_BUF_T buf, void *data )
+{
+ VCOS_LOG_CAT_T *category = data;
+ const char *str = vcos_cfg_buf_get_str( buf );
+ VCOS_LOG_LEVEL_T level;
+
+ if ( vcos_string_to_log_level( str, &level ) == VCOS_SUCCESS )
+ {
+ category->level = level;
+ }
+ else
+ {
+ printk( KERN_ERR "%s: Unrecognized logging level: '%s'\n",
+ __func__, str );
+ }
+}
+
+/*****************************************************************************
+*
+* _vcos_log_platform_register is called from vcos_log_register whenever
+* a new category is registered.
+*
+*****************************************************************************/
+
+void _vcos_log_platform_register(VCOS_LOG_CAT_T *category)
+{
+ VCOS_CFG_ENTRY_T entry;
+
+ if ( vcos_cfg_create_entry( &entry, &vcos_logging_cfg_dir, category->name,
+ logging_show_category, logging_parse_category,
+ category ) != VCOS_SUCCESS )
+ {
+ printk( KERN_ERR "%s: Unable to create cfg entry for logging category '%s'\n",
+ __func__, category->name );
+ category->platform_data = NULL;
+ }
+ else
+ {
+ category->platform_data = entry;
+ }
+}
+
+/*****************************************************************************
+*
+* _vcos_log_platform_unregister is called from vcos_log_unregister whenever
+* a new category is unregistered.
+*
+*****************************************************************************/
+
+void _vcos_log_platform_unregister(VCOS_LOG_CAT_T *category)
+{
+ VCOS_CFG_ENTRY_T entry;
+
+ entry = category->platform_data;
+ if ( entry != NULL )
+ {
+ if ( vcos_cfg_remove_entry( &entry ) != VCOS_SUCCESS )
+ {
+ printk( KERN_ERR "%s: Unable to remove cfg entry for logging category '%s'\n",
+ __func__, category->name );
+ }
+ }
+}
+
+/*****************************************************************************
+*
+* Allocate memory.
+*
+*****************************************************************************/
+
+void *vcos_platform_malloc( VCOS_UNSIGNED required_size )
+{
+ if ( required_size >= ( 2 * PAGE_SIZE ))
+ {
+ /* For larger allocations, use vmalloc, whose underlying allocator
+ * returns pages
+ */
+
+ return vmalloc( required_size );
+ }
+
+ /* For smaller allocation, use kmalloc */
+
+ return kmalloc( required_size, GFP_KERNEL );
+}
+
+/*****************************************************************************
+*
+* Free previously allocated memory
+*
+*****************************************************************************/
+
+void vcos_platform_free( void *ptr )
+{
+ if (((unsigned long)ptr >= VMALLOC_START )
+ && ((unsigned long)ptr < VMALLOC_END ))
+ {
+ vfree( ptr );
+ }
+ else
+ {
+ kfree( ptr );
+ }
+}
+
+/*****************************************************************************
+*
+* Execute a routine exactly once.
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_once(VCOS_ONCE_T *once_control,
+ void (*init_routine)(void))
+{
+ /* In order to be thread-safe we need to re-test *once_control
+ * inside the lock. The outer test is basically an optimization
+ * so that once it is initialized we don't need to waste time
+ * trying to acquire the lock.
+ */
+
+ if ( *once_control == 0 )
+ {
+ vcos_global_lock();
+ if ( *once_control == 0 )
+ {
+ init_routine();
+ *once_control = 1;
+ }
+ vcos_global_unlock();
+ }
+
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* String duplication routine.
+*
+*****************************************************************************/
+
+char *vcos_strdup(const char *str)
+{
+ return kstrdup(str, GFP_KERNEL);
+}
+
+
+/* Export functions for modules to use */
+EXPORT_SYMBOL( vcos_init );
+
+EXPORT_SYMBOL( vcos_semaphore_trywait );
+EXPORT_SYMBOL( vcos_semaphore_post );
+EXPORT_SYMBOL( vcos_semaphore_create );
+EXPORT_SYMBOL( vcos_semaphore_wait );
+EXPORT_SYMBOL( vcos_semaphore_delete );
+
+EXPORT_SYMBOL( vcos_log_impl );
+EXPORT_SYMBOL( vcos_vlog_impl );
+EXPORT_SYMBOL( vcos_vlog_default_impl );
+EXPORT_SYMBOL( vcos_log_get_default_category );
+EXPORT_SYMBOL( vcos_log_register );
+EXPORT_SYMBOL( vcos_log_unregister );
+EXPORT_SYMBOL( vcos_logging_init );
+EXPORT_SYMBOL( vcos_log_level_to_string );
+EXPORT_SYMBOL( vcos_string_to_log_level );
+EXPORT_SYMBOL( vcos_log_dump_mem_impl );
+
+EXPORT_SYMBOL( vcos_event_create );
+EXPORT_SYMBOL( vcos_event_delete );
+EXPORT_SYMBOL( vcos_event_flags_set );
+EXPORT_SYMBOL( vcos_event_signal );
+EXPORT_SYMBOL( vcos_event_wait );
+EXPORT_SYMBOL( vcos_event_try );
+
+EXPORT_SYMBOL( vcos_getmicrosecs );
+
+EXPORT_SYMBOL( vcos_strcasecmp );
+EXPORT_SYMBOL( vcos_snprintf );
+EXPORT_SYMBOL( vcos_vsnprintf );
+
+EXPORT_SYMBOL( vcos_thread_current );
+EXPORT_SYMBOL( vcos_thread_join );
+EXPORT_SYMBOL( vcos_thread_create );
+EXPORT_SYMBOL( vcos_thread_set_priority );
+EXPORT_SYMBOL( vcos_thread_exit );
+EXPORT_SYMBOL( vcos_once );
+
+EXPORT_SYMBOL( vcos_thread_attr_init );
+EXPORT_SYMBOL( vcos_thread_attr_setpriority );
+EXPORT_SYMBOL( vcos_thread_attr_settimeslice );
+EXPORT_SYMBOL( vcos_thread_attr_setstacksize );
+EXPORT_SYMBOL( _vcos_thread_attr_setlegacyapi );
+
+EXPORT_SYMBOL( vcos_event_flags_create );
+EXPORT_SYMBOL( vcos_event_flags_delete );
+EXPORT_SYMBOL( vcos_event_flags_get );
+
+EXPORT_SYMBOL( vcos_sleep );
+
+EXPORT_SYMBOL( vcos_calloc );
+EXPORT_SYMBOL( vcos_malloc );
+EXPORT_SYMBOL( vcos_malloc_aligned );
+EXPORT_SYMBOL( vcos_free );
+
+EXPORT_SYMBOL( vcos_mutex_create );
+EXPORT_SYMBOL( vcos_mutex_delete );
+EXPORT_SYMBOL( vcos_mutex_lock );
+EXPORT_SYMBOL( vcos_mutex_unlock );
+EXPORT_SYMBOL( vcos_mutex_trylock );
+
+EXPORT_SYMBOL( vcos_timer_cancel );
+EXPORT_SYMBOL( vcos_timer_create );
+EXPORT_SYMBOL( vcos_timer_delete );
+EXPORT_SYMBOL( vcos_timer_set );
+
+EXPORT_SYMBOL( vcos_atomic_flags_create );
+EXPORT_SYMBOL( vcos_atomic_flags_delete );
+EXPORT_SYMBOL( vcos_atomic_flags_or );
+EXPORT_SYMBOL( vcos_atomic_flags_get_and_clear );
+
+EXPORT_SYMBOL( vcos_verify_bkpts_enabled );
+
+EXPORT_SYMBOL( vcos_strdup );
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel_cfg.c
@@ -0,0 +1,332 @@
+/*****************************************************************************
+* Copyright 2009 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#include "interface/vcos/vcos.h"
+#include <linux/module.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+#include <asm/uaccess.h>
+
+struct opaque_vcos_cfg_buf_t
+{
+ struct seq_file *seq;
+ char *charBuf;
+};
+
+struct opaque_vcos_cfg_entry_t
+{
+ struct proc_dir_entry *pde;
+ struct proc_dir_entry *parent_pde;
+ VCOS_CFG_SHOW_FPTR showFunc;
+ VCOS_CFG_PARSE_FPTR parseFunc;
+ void *data;
+ const char *name;
+};
+
+/*****************************************************************************
+*
+* cfg_proc_show
+*
+*****************************************************************************/
+
+static int cfg_proc_show( struct seq_file *s, void *v )
+{
+ VCOS_CFG_ENTRY_T entry;
+ struct opaque_vcos_cfg_buf_t buf;
+
+ entry = s->private;
+
+ if ( entry->showFunc )
+ {
+ memset( &buf, 0, sizeof( buf ));
+ buf.seq = s;
+
+ entry->showFunc( &buf, entry->data );
+ }
+
+ return 0;
+}
+
+/*****************************************************************************
+*
+* cfg_proc_write
+*
+*****************************************************************************/
+
+static ssize_t cfg_proc_write( struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
+{
+ VCOS_CFG_ENTRY_T entry = PDE(file->f_path.dentry->d_inode)->data;
+ char *charBuf;
+ struct opaque_vcos_cfg_buf_t buf;
+ size_t len;
+
+ if ( entry->parseFunc != NULL )
+ {
+ /* The number 4000 is rather arbitrary. It just needs to be bigger than any input
+ * string we expect to use.
+ */
+
+ len = count;
+ if ( count > 4000 )
+ {
+ len = 4000;
+ }
+
+ /* Allocate a kernel buffer to contain the string being written. */
+
+ charBuf = kmalloc( len + 1, GFP_KERNEL );
+ if ( copy_from_user( charBuf, buffer, len ))
+ {
+ kfree( charBuf );
+ return -EFAULT;
+ }
+
+ /* echo puts a trailing newline in the buffer - strip it out. */
+
+ if (( len > 0 ) && ( charBuf[ len - 1 ] == '\n' ))
+ {
+ len--;
+ }
+ charBuf[len] = '\0';
+
+ memset( &buf, 0, sizeof( buf ));
+ buf.charBuf = charBuf;
+
+ entry->parseFunc( &buf, entry->data );
+ kfree( charBuf );
+ }
+ return count;
+}
+
+/*****************************************************************************
+*
+* cfg_proc_open
+*
+*****************************************************************************/
+
+static int cfg_proc_open( struct inode *inode, struct file *file )
+{
+ return single_open( file, cfg_proc_show, PDE(inode)->data );
+}
+
+static const struct file_operations cfg_proc_fops =
+{
+ .open = cfg_proc_open,
+ .read = seq_read,
+ .llseek = seq_lseek,
+ .release = single_release,
+ .write = cfg_proc_write,
+};
+
+/*****************************************************************************
+*
+* vcos_cfg_mkdir
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cfg_mkdir( VCOS_CFG_ENTRY_T *entryp,
+ VCOS_CFG_ENTRY_T *parent,
+ const char *dirName )
+{
+ VCOS_CFG_ENTRY_T entry;
+
+ if (( entry = kzalloc( sizeof( *entry ), GFP_KERNEL )) == NULL )
+ {
+ return VCOS_ENOMEM;
+ }
+
+ if ( parent == NULL )
+ {
+ entry->pde = proc_mkdir( dirName, NULL );
+ }
+ else
+ {
+ entry->pde = proc_mkdir( dirName, (*parent)->pde );
+ entry->parent_pde = (*parent)->pde;
+ }
+ if ( entry->pde == NULL )
+ {
+ kfree( entry );
+ return VCOS_ENOMEM;
+ }
+
+ entry->name = dirName;
+
+ *entryp = entry;
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_create_entry
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cfg_create_entry( VCOS_CFG_ENTRY_T *entryp,
+ VCOS_CFG_ENTRY_T *parent,
+ const char *entryName,
+ VCOS_CFG_SHOW_FPTR showFunc,
+ VCOS_CFG_PARSE_FPTR parseFunc,
+ void *data )
+{
+ VCOS_CFG_ENTRY_T entry;
+ mode_t mode;
+
+ *entryp = NULL;
+
+ if (( entry = kzalloc( sizeof( *entry ), GFP_KERNEL )) == NULL )
+ {
+ return VCOS_ENOMEM;
+ }
+
+ mode = 0;
+ if ( showFunc != NULL )
+ {
+ mode |= 0444;
+ }
+ if ( parseFunc != NULL )
+ {
+ mode |= 0200;
+ }
+
+ if ( parent == NULL )
+ {
+ entry->pde = create_proc_entry( entryName, mode, NULL );
+ }
+ else
+ {
+ entry->pde = create_proc_entry( entryName, mode, (*parent)->pde );
+ entry->parent_pde = (*parent)->pde;
+ }
+ if ( entry->pde == NULL )
+ {
+ kfree( entry );
+ return -ENOMEM;
+ }
+ entry->showFunc = showFunc;
+ entry->parseFunc = parseFunc;
+ entry->data = data;
+ entry->name = entryName;
+
+ entry->pde->data = entry;
+ entry->pde->proc_fops = &cfg_proc_fops;
+
+ *entryp = entry;
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_remove_entry
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_cfg_remove_entry( VCOS_CFG_ENTRY_T *entryp )
+{
+ if (( entryp != NULL ) && ( *entryp != NULL ))
+ {
+ remove_proc_entry( (*entryp)->name, (*entryp)->parent_pde );
+
+ kfree( *entryp );
+ *entryp = NULL;
+ }
+
+ return VCOS_SUCCESS;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_is_entry_created
+*
+*****************************************************************************/
+
+int vcos_cfg_is_entry_created( VCOS_CFG_ENTRY_T entry )
+{
+ return ( entry != NULL ) && ( entry->pde != NULL );
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_buf_printf
+*
+*****************************************************************************/
+
+void vcos_cfg_buf_printf( VCOS_CFG_BUF_T buf, const char *fmt, ... )
+{
+ struct seq_file *m = buf->seq;
+
+ /* Bah - there is no seq_vprintf */
+
+ va_list args;
+ int len;
+
+ if (m->count < m->size) {
+ va_start(args, fmt);
+ len = vsnprintf(m->buf + m->count, m->size - m->count, fmt, args);
+ va_end(args);
+ if (m->count + len < m->size) {
+ m->count += len;
+ return;
+ }
+ }
+ m->count = m->size;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_buf_get_str
+*
+*****************************************************************************/
+
+char *vcos_cfg_buf_get_str( VCOS_CFG_BUF_T buf )
+{
+ return buf->charBuf;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_get_proc_entry
+*
+* This function is only created for a couple of backwards compatibility '
+* issues and shouldn't normally be used.
+*
+*****************************************************************************/
+
+void *vcos_cfg_get_proc_entry( VCOS_CFG_ENTRY_T entry )
+{
+ return entry->pde;
+}
+
+/*****************************************************************************
+*
+* vcos_cfg_get_entry_name
+*
+*****************************************************************************/
+
+const char *vcos_cfg_get_entry_name( VCOS_CFG_ENTRY_T entry )
+{
+ return entry->pde->name;
+}
+
+
+EXPORT_SYMBOL( vcos_cfg_mkdir );
+EXPORT_SYMBOL( vcos_cfg_create_entry );
+EXPORT_SYMBOL( vcos_cfg_remove_entry );
+EXPORT_SYMBOL( vcos_cfg_get_entry_name );
+EXPORT_SYMBOL( vcos_cfg_is_entry_created );
+EXPORT_SYMBOL( vcos_cfg_buf_printf );
+EXPORT_SYMBOL( vcos_cfg_buf_get_str );
+
+EXPORT_SYMBOL_GPL( vcos_cfg_get_proc_entry );
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_linuxkernel_misc.c
@@ -0,0 +1,113 @@
+// #############################################################################
+// START #######################################################################
+/*****************************************************************************
+* Copyright 2009 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#include "interface/vcos/vcos.h"
+#include <linux/sched.h>
+#include <linux/module.h>
+#include <linux/freezer.h>
+#include <linux/string.h>
+#include <linux/slab.h>
+
+/*****************************************************************************
+*
+* vcos_semaphore_wait_freezable
+*
+*****************************************************************************/
+
+VCOS_STATUS_T vcos_semaphore_wait_freezable(VCOS_SEMAPHORE_T *sem)
+{
+ int rval, sig_pended = 0;
+ unsigned long flags;
+ struct task_struct *task = current;
+
+ while (1) {
+ rval = down_interruptible((struct semaphore *)sem);
+ if (rval == 0) { /* down now */
+ break;
+ } else {
+ if (freezing(current)) {
+ try_to_freeze();
+ } else {
+ spin_lock_irqsave(&task->sighand->siglock, flags);
+ if (test_tsk_thread_flag(task, TIF_SIGPENDING)) {
+ clear_tsk_thread_flag(task, TIF_SIGPENDING);
+ sig_pended = 1;
+ }
+ spin_unlock_irqrestore(&task->sighand->siglock, flags);
+ }
+ }
+ }
+
+ if (sig_pended) {
+ spin_lock_irqsave(&task->sighand->siglock, flags);
+ set_tsk_thread_flag(task, TIF_SIGPENDING);
+ spin_unlock_irqrestore(&task->sighand->siglock, flags);
+ }
+
+ return 0;
+}
+
+EXPORT_SYMBOL( vcos_semaphore_wait_freezable );
+
+/*****************************************************************************
+*
+* vcos_kmalloc
+*
+* We really need to convert malloc to do kmalloc or vmalloc based on the
+* size, but for now we'll add a separate function.
+*
+*****************************************************************************/
+
+void *vcos_kmalloc(VCOS_UNSIGNED size, const char *description)
+{
+ (void)description;
+
+ return kmalloc( size, GFP_KERNEL );
+}
+
+/*****************************************************************************
+*
+* vcos_kmalloc
+*
+* We really need to convert malloc to do kmalloc or vmalloc based on the
+* size, but for now we'll add a separate function.
+*
+*****************************************************************************/
+
+void *vcos_kcalloc(VCOS_UNSIGNED num, VCOS_UNSIGNED size, const char *description)
+{
+ (void)description;
+
+ return kzalloc( num * size, GFP_KERNEL );
+}
+
+/*****************************************************************************
+*
+* vcos_kfree
+*
+*****************************************************************************/
+
+void vcos_kfree(void *ptr)
+{
+ kfree( ptr );
+}
+
+EXPORT_SYMBOL( vcos_kmalloc );
+EXPORT_SYMBOL( vcos_kcalloc );
+EXPORT_SYMBOL( vcos_kfree );
+
+// END #########################################################################
+// #############################################################################
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_mod_init.c
@@ -0,0 +1,64 @@
+/*****************************************************************************
+* Copyright 2006 - 2008 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+****************************************************************************/
+
+/* ---- Include Files ---------------------------------------------------- */
+
+#include "interface/vcos/vcos.h"
+#include <linux/module.h>
+
+/* ---- Public Variables ------------------------------------------------- */
+
+/* ---- Private Constants and Types -------------------------------------- */
+
+/* ---- Private Variables ------------------------------------------------ */
+
+/* ---- Private Function Prototypes -------------------------------------- */
+
+/* ---- Functions -------------------------------------------------------- */
+
+/****************************************************************************
+*
+* Called to perform module initialization when the module is loaded
+*
+***************************************************************************/
+
+static int __init vcos_mod_init( void )
+{
+ printk( KERN_INFO "VCOS Module\n" );
+
+ vcos_init();
+ return 0;
+}
+
+/****************************************************************************
+*
+* Called to perform module cleanup when the module is unloaded.
+*
+***************************************************************************/
+
+static void __exit vcos_mod_exit( void )
+{
+ vcos_deinit();
+}
+
+/****************************************************************************/
+
+module_init( vcos_mod_init );
+module_exit( vcos_mod_exit );
+
+MODULE_AUTHOR("Broadcom");
+MODULE_DESCRIPTION( "VCOS Module Functions" );
+MODULE_LICENSE( "GPL" );
+MODULE_VERSION( "1.0" );
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_platform.h
@@ -0,0 +1,496 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : vcos
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - Linux kernel (partial) implementation.
+=============================================================================*/
+
+/* Do not include this file directly - instead include it via vcos.h */
+
+/** @file
+ *
+ * Linux kernel (partial) implementation of VCOS.
+ *
+ */
+
+#ifndef VCOS_PLATFORM_H
+#define VCOS_PLATFORM_H
+
+#include <linux/types.h>
+#include <linux/semaphore.h>
+#include <linux/mutex.h>
+#include <asm/bitops.h>
+#include <linux/kthread.h>
+#include <linux/wait.h>
+#include <linux/vmalloc.h>
+#include <linux/jiffies.h>
+#include <linux/delay.h>
+#include <linux/string.h>
+#include <linux/types.h>
+#include <linux/interrupt.h>
+#include <linux/random.h>
+#include <linux/sched.h>
+#include <linux/ctype.h>
+#include <linux/uaccess.h>
+#include <linux/time.h> /* for time_t */
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+
+#define VCOS_HAVE_RTOS 1
+#define VCOS_HAVE_SEMAPHORE 1
+#define VCOS_HAVE_EVENT 1
+#define VCOS_HAVE_QUEUE 0
+#define VCOS_HAVE_LEGACY_ISR 0
+#define VCOS_HAVE_TIMER 1
+#define VCOS_HAVE_CANCELLATION_SAFE_TIMER 0
+#define VCOS_HAVE_MEMPOOL 0
+#define VCOS_HAVE_ISR 0
+#define VCOS_HAVE_ATOMIC_FLAGS 1
+#define VCOS_HAVE_BLOCK_POOL 0
+#define VCOS_HAVE_ONCE 1
+#define VCOS_HAVE_FILE 0
+#define VCOS_HAVE_USER_BUF 0
+#define VCOS_HAVE_CFG 1
+#define VCOS_HAVE_SPINLOCK 0
+#define VCOS_HAVE_CMD 1
+#define VCOS_HAVE_EVENT_FLAGS 1
+
+/* Exclude many VCOS classes which don't have predicates */
+#define VCOS_TLS_H
+#define VCOS_NAMED_MUTEX_H
+#define VCOS_REENTRANT_MUTEX_H
+#define VCOS_NAMED_SEMAPHORE_H
+#define VCOS_QUICKSLOW_MUTEX_H
+/*#define VCOS_INIT_H */
+/*#define VCOS_MEM_H */
+/*#define VCOS_STRING_H */
+
+typedef struct semaphore VCOS_SEMAPHORE_T;
+typedef struct semaphore VCOS_EVENT_T;
+typedef struct mutex VCOS_MUTEX_T;
+typedef volatile int VCOS_ONCE_T;
+
+typedef unsigned int VCOS_UNSIGNED;
+typedef unsigned int VCOS_OPTION;
+typedef atomic_t VCOS_ATOMIC_FLAGS_T;
+
+typedef struct
+{
+ struct timer_list linux_timer;
+ void *context;
+ void (*expiration_routine)(void *context);
+
+} VCOS_TIMER_T;
+
+typedef struct VCOS_LLTHREAD_T
+{
+ struct task_struct *thread; /**< The thread itself */
+ VCOS_SEMAPHORE_T suspend; /**< For support event groups and similar - a per thread semaphore */
+} VCOS_LLTHREAD_T;
+
+typedef enum
+{
+ VCOS_O_RDONLY = 00000000,
+ VCOS_O_WRONLY = 00000001,
+ VCOS_O_RDWR = 00000002,
+ VCOS_O_TRUNC = 00001000,
+} VCOS_FILE_FLAGS_T;
+
+typedef struct file *VCOS_FILE_T;
+
+#define VCOS_SUSPEND -1
+#define VCOS_NO_SUSPEND 0
+
+#define VCOS_START 1
+#define VCOS_NO_START 0
+
+#define VCOS_THREAD_PRI_MIN -20
+#define VCOS_THREAD_PRI_MAX 19
+
+#define VCOS_THREAD_PRI_INCREASE -1
+#define VCOS_THREAD_PRI_HIGHEST VCOS_THREAD_PRI_MIN
+#define VCOS_THREAD_PRI_LOWEST VCOS_THREAD_PRI_MAX
+#define VCOS_THREAD_PRI_NORMAL ((VCOS_THREAD_PRI_MAX+VCOS_THREAD_PRI_MIN)/2)
+#define VCOS_THREAD_PRI_ABOVE_NORMAL (VCOS_THREAD_PRI_NORMAL + VCOS_THREAD_PRI_INCREASE)
+#define VCOS_THREAD_PRI_REALTIME VCOS_THREAD_PRI_HIGHEST
+
+#define _VCOS_AFFINITY_DEFAULT 0
+#define _VCOS_AFFINITY_CPU0 0
+#define _VCOS_AFFINITY_CPU1 0
+#define _VCOS_AFFINITY_MASK 0
+#define VCOS_CAN_SET_STACK_ADDR 0
+
+#define VCOS_TICKS_PER_SECOND HZ
+
+#include "interface/vcos/generic/vcos_generic_event_flags.h"
+#include "interface/vcos/generic/vcos_mem_from_malloc.h"
+#include "interface/vcos/generic/vcos_joinable_thread_from_plain.h"
+
+/***********************************************************
+ *
+ * Memory allcoation
+ *
+ ***********************************************************/
+
+#define _vcos_platform_malloc vcos_platform_malloc
+#define _vcos_platform_free vcos_platform_free
+
+void *vcos_platform_malloc( VCOS_UNSIGNED required_size );
+void vcos_platform_free( void *ptr );
+
+#if defined(VCOS_INLINE_BODIES)
+
+#undef VCOS_ASSERT_LOGGING_DISABLE
+#define VCOS_ASSERT_LOGGING_DISABLE 1
+
+/***********************************************************
+ *
+ * Counted Semaphores
+ *
+ ***********************************************************/
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_semaphore_wait(VCOS_SEMAPHORE_T *sem) {
+ int ret = down_interruptible(sem);
+ if ( ret == 0 )
+ /* Success */
+ return VCOS_SUCCESS;
+ else if ( ret == -EINTR )
+ /* Interrupted */
+ return VCOS_EINTR;
+ else
+ /* Default (timeout) */
+ return VCOS_EAGAIN;
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_semaphore_trywait(VCOS_SEMAPHORE_T *sem) {
+ if (down_trylock(sem) != 0)
+ return VCOS_EAGAIN;
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_semaphore_create(VCOS_SEMAPHORE_T *sem,
+ const char *name,
+ VCOS_UNSIGNED initial_count) {
+ sema_init(sem, initial_count);
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+void vcos_semaphore_delete(VCOS_SEMAPHORE_T *sem) {
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_semaphore_post(VCOS_SEMAPHORE_T *sem) {
+ up(sem);
+ return VCOS_SUCCESS;
+}
+
+/***********************************************************
+ *
+ * Threads
+ *
+ ***********************************************************/
+
+#include "vcos_thread_map.h"
+
+VCOS_INLINE_IMPL
+VCOS_LLTHREAD_T *vcos_llthread_current(void) {
+ return &vcos_kthread_current()->thread;
+}
+
+VCOS_INLINE_IMPL
+void vcos_llthread_resume(VCOS_LLTHREAD_T *thread) {
+ vcos_assert(0);
+}
+
+VCOS_INLINE_IMPL
+void vcos_sleep(uint32_t ms) {
+ msleep(ms);
+}
+
+VCOS_INLINE_IMPL
+void vcos_thread_set_priority(VCOS_THREAD_T *thread, VCOS_UNSIGNED p) {
+ /* not implemented */
+}
+VCOS_INLINE_IMPL
+VCOS_UNSIGNED vcos_thread_get_priority(VCOS_THREAD_T *thread) {
+ /* not implemented */
+ return 0;
+}
+
+/***********************************************************
+ *
+ * Miscellaneous
+ *
+ ***********************************************************/
+
+VCOS_INLINE_IMPL
+int vcos_strcasecmp(const char *s1, const char *s2) {
+ return strcasecmp(s1,s2);
+}
+
+
+/***********************************************************
+ *
+ * Mutexes
+ *
+ ***********************************************************/
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_mutex_create(VCOS_MUTEX_T *m, const char *name) {
+ mutex_init(m);
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+void vcos_mutex_delete(VCOS_MUTEX_T *m) {
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_mutex_lock(VCOS_MUTEX_T *m) {
+ int ret = mutex_lock_interruptible(m);
+ if ( ret == 0 )
+ /* Success */
+ return VCOS_SUCCESS;
+ else if ( ret == -EINTR )
+ /* Interrupted */
+ return VCOS_EINTR;
+ else
+ /* Default */
+ return VCOS_EAGAIN;
+}
+
+VCOS_INLINE_IMPL
+void vcos_mutex_unlock(VCOS_MUTEX_T *m) {
+ mutex_unlock(m);
+}
+
+VCOS_INLINE_IMPL
+int vcos_mutex_is_locked(VCOS_MUTEX_T *m) {
+ if (mutex_trylock(m) != 0)
+ return 1; /* it was locked */
+ mutex_unlock(m);
+ /* it wasn't locked */
+ return 0;
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_mutex_trylock(VCOS_MUTEX_T *m) {
+ if (mutex_trylock(m) == 0)
+ return VCOS_SUCCESS;
+ else
+ return VCOS_EAGAIN;
+}
+
+/* For supporting event groups - per thread semaphore */
+VCOS_INLINE_IMPL
+void _vcos_thread_sem_wait(void) {
+ VCOS_THREAD_T *t = vcos_thread_current();
+ vcos_semaphore_wait(&t->suspend);
+}
+
+VCOS_INLINE_IMPL
+void _vcos_thread_sem_post(VCOS_THREAD_T *target) {
+ vcos_semaphore_post(&target->suspend);
+}
+
+/***********************************************************
+ *
+ * Events
+ *
+ ***********************************************************/
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_event_create(VCOS_EVENT_T *event, const char *debug_name)
+{
+ sema_init(event, 0);
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+void vcos_event_signal(VCOS_EVENT_T *event)
+{
+ up(event);
+}
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_event_wait(VCOS_EVENT_T *event)
+{
+ int ret = down_interruptible(event);
+ if ( ret == -EINTR )
+ /* Interrupted */
+ return VCOS_EINTR;
+ else if (ret != 0)
+ /* Default (timeout) */
+ return VCOS_EAGAIN;
+ /* Emulate a maximum count of 1 by removing any extra upness */
+ while (down_trylock(event) == 0) continue;
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_try(VCOS_EVENT_T *event)
+{
+ return (down_trylock(event) == 0) ? VCOS_SUCCESS : VCOS_EAGAIN;
+}
+
+VCOS_INLINE_IMPL
+void vcos_event_delete(VCOS_EVENT_T *event)
+{
+}
+
+/***********************************************************
+ *
+ * Timers
+ *
+ ***********************************************************/
+
+VCOS_INLINE_DECL
+void vcos_timer_linux_func(unsigned long data)
+{
+ VCOS_TIMER_T *vcos_timer = (VCOS_TIMER_T *)data;
+
+ vcos_timer->expiration_routine( vcos_timer->context );
+}
+
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_timer_create(VCOS_TIMER_T *timer,
+ const char *name,
+ void (*expiration_routine)(void *context),
+ void *context) {
+ init_timer(&timer->linux_timer);
+ timer->linux_timer.data = (unsigned long)timer;
+ timer->linux_timer.function = vcos_timer_linux_func;
+
+ timer->context = context;
+ timer->expiration_routine = expiration_routine;
+
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+void vcos_timer_set(VCOS_TIMER_T *timer, VCOS_UNSIGNED delay_ms) {
+ timer->linux_timer.expires = jiffies + msecs_to_jiffies(delay_ms);
+ add_timer(&timer->linux_timer);
+}
+
+VCOS_INLINE_IMPL
+void vcos_timer_cancel(VCOS_TIMER_T *timer) {
+ del_timer(&timer->linux_timer);
+}
+
+VCOS_INLINE_IMPL
+void vcos_timer_reset(VCOS_TIMER_T *timer, VCOS_UNSIGNED delay_ms) {
+ del_timer_sync(&timer->linux_timer);
+ timer->linux_timer.expires = jiffies + msecs_to_jiffies(delay_ms);
+ add_timer(&timer->linux_timer);
+}
+
+VCOS_INLINE_IMPL
+void vcos_timer_delete(VCOS_TIMER_T *timer) {
+ timer->context = NULL;
+ timer->expiration_routine = NULL;
+ timer->linux_timer.function = NULL;
+ timer->linux_timer.data = 0;
+ return;
+}
+
+VCOS_INLINE_IMPL
+VCOS_UNSIGNED vcos_process_id_current(void) {
+ return (VCOS_UNSIGNED)current->pid;
+}
+
+
+VCOS_INLINE_IMPL
+int vcos_in_interrupt(void) {
+ return in_interrupt();
+}
+
+/***********************************************************
+ *
+ * Atomic flags
+ *
+ ***********************************************************/
+
+VCOS_INLINE_IMPL
+VCOS_STATUS_T vcos_atomic_flags_create(VCOS_ATOMIC_FLAGS_T *atomic_flags)
+{
+ atomic_set(atomic_flags, 0);
+ return VCOS_SUCCESS;
+}
+
+VCOS_INLINE_IMPL
+void vcos_atomic_flags_or(VCOS_ATOMIC_FLAGS_T *atomic_flags, uint32_t flags)
+{
+ uint32_t value;
+ do {
+ value = atomic_read(atomic_flags);
+ } while (atomic_cmpxchg(atomic_flags, value, value | flags) != value);
+}
+
+VCOS_INLINE_IMPL
+uint32_t vcos_atomic_flags_get_and_clear(VCOS_ATOMIC_FLAGS_T *atomic_flags)
+{
+ return atomic_xchg(atomic_flags, 0);
+}
+
+VCOS_INLINE_IMPL
+void vcos_atomic_flags_delete(VCOS_ATOMIC_FLAGS_T *atomic_flags)
+{
+}
+
+#undef VCOS_ASSERT_LOGGING_DISABLE
+#define VCOS_ASSERT_LOGGING_DISABLE 0
+
+#endif /* VCOS_INLINE_BODIES */
+
+VCOS_INLINE_DECL void _vcos_thread_sem_wait(void);
+VCOS_INLINE_DECL void _vcos_thread_sem_post(VCOS_THREAD_T *);
+
+/***********************************************************
+ *
+ * Misc
+ *
+ ***********************************************************/
+VCOS_INLINE_DECL char *vcos_strdup(const char *str);
+
+/***********************************************************
+ *
+ * Logging
+ *
+ ***********************************************************/
+
+VCOSPRE_ const char * VCOSPOST_ _vcos_log_level(void);
+#define _VCOS_LOG_LEVEL() _vcos_log_level()
+
+#define vcos_log_platform_init() _vcos_log_platform_init()
+#define vcos_log_platform_register(category) _vcos_log_platform_register(category)
+#define vcos_log_platform_unregister(category) _vcos_log_platform_unregister(category)
+
+struct VCOS_LOG_CAT_T; /* Forward declaration since vcos_logging.h hasn't been included yet */
+
+void _vcos_log_platform_init(void);
+void _vcos_log_platform_register(struct VCOS_LOG_CAT_T *category);
+void _vcos_log_platform_unregister(struct VCOS_LOG_CAT_T *category);
+
+/***********************************************************
+ *
+ * Memory barriers
+ *
+ ***********************************************************/
+
+#define vcos_wmb(x) wmb()
+#define vcos_rmb() rmb()
+
+#include "interface/vcos/generic/vcos_common.h"
+/*#include "interface/vcos/generic/vcos_generic_quickslow_mutex.h" */
+
+#endif /* VCOS_PLATFORM_H */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_platform_types.h
@@ -0,0 +1,47 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : osal
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - platform-specific types and defines
+=============================================================================*/
+
+#ifndef VCOS_PLATFORM_TYPES_H
+#define VCOS_PLATFORM_TYPES_H
+
+#include <stddef.h>
+#include <linux/types.h>
+#include <linux/bug.h>
+
+#define VCOSPRE_ extern
+#define VCOSPOST_
+
+#if defined(__GNUC__) && (( __GNUC__ > 2 ) || (( __GNUC__ == 2 ) && ( __GNUC_MINOR__ >= 3 )))
+#define VCOS_FORMAT_ATTR_(ARCHETYPE, STRING_INDEX, FIRST_TO_CHECK) __attribute__ ((format (ARCHETYPE, STRING_INDEX, FIRST_TO_CHECK)))
+#else
+#define VCOS_FORMAT_ATTR_(ARCHETYPE, STRING_INDEX, FIRST_TO_CHECK)
+#endif
+
+#if !defined( __STDC_VERSION__ )
+#define __STDC_VERSION__ 199901L
+#endif
+
+#if !defined( __STDC_VERSION )
+#define __STDC_VERSION __STDC_VERSION__
+#endif
+
+static inline void __vcos_bkpt( void ) { BUG(); }
+#define VCOS_BKPT __vcos_bkpt()
+
+#define VCOS_ASSERT_MSG(...) printk( KERN_ERR "vcos_assert: " __VA_ARGS__ )
+
+#define PRId64 "lld"
+#define PRIi64 "lli"
+#define PRIo64 "llo"
+#define PRIu64 "llu"
+#define PRIx64 "llx"
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_thread_map.c
@@ -0,0 +1,129 @@
+/*****************************************************************************
+* Copyright 2009 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+/** Support to allow VCOS thread-related functions to be called from
+ * threads that were not created by VCOS.
+ */
+
+#include <linux/semaphore.h>
+#include <linux/vmalloc.h>
+#include <linux/list.h>
+#include <linux/sched.h>
+
+#include "vcos_thread_map.h"
+#include "interface/vcos/vcos_logging.h"
+
+/*
+ * Store the vcos_thread pointer at the end of
+ * current kthread stack, right after the thread_info
+ * structure.
+ *
+ * I belive we should be safe here to steal these 4 bytes
+ * from the stack, as long as the vcos thread does not use up
+ * all the stack available
+ *
+ * NOTE: This scheme will not work on architectures with stack growing up
+ */
+
+/* Shout, if we are not being compiled for ARM kernel */
+
+#ifndef CONFIG_ARM
+#error " **** The vcos kthread implementation may not work for non-ARM kernel ****"
+#endif
+
+static inline void *to_current_vcos_thread(void)
+{
+ unsigned long *vcos_data;
+
+ vcos_data = (unsigned long *)((char *)current_thread_info() + sizeof(struct thread_info));
+
+ return (void *)vcos_data;
+}
+
+
+static inline void *to_vcos_thread(struct task_struct *tsk)
+{
+ unsigned long *vcos_data;
+
+ vcos_data = (unsigned long *)((char *)tsk->stack + sizeof(struct thread_info));
+
+ return (void *)vcos_data;
+}
+
+/**
+ @fn uint32_t vcos_add_thread(THREAD_MAP_T *vcos_thread);
+*/
+uint32_t vcos_add_thread(VCOS_THREAD_T *vcos_thread)
+{
+ VCOS_THREAD_T **vcos_thread_storage = (VCOS_THREAD_T **)to_current_vcos_thread();
+
+ *vcos_thread_storage = vcos_thread;
+
+ return(0);
+}
+
+
+/**
+ @fn uint32_t vcos_remove_thread(struct task_struct * thread_id);
+*/
+uint32_t vcos_remove_thread(struct task_struct *thread_id)
+{
+ /* Remove thread_id -> VCOS_THREAD_T relationship */
+ VCOS_THREAD_T **vcos_thread_storage;
+
+ /*
+ * We want to be able to build vcos as a loadable module, which
+ * means that we can't call get_task_struct. So we assert if we're
+ * ever called with thread_id != current.
+ */
+
+ BUG_ON( thread_id != current );
+
+ vcos_thread_storage = (VCOS_THREAD_T **)to_vcos_thread(thread_id);
+
+ *(unsigned long *)vcos_thread_storage = 0xCAFEBABE;
+
+ return(0);
+}
+
+
+VCOS_THREAD_T *vcos_kthread_current(void)
+{
+ VCOS_THREAD_T **vcos_thread_storage = (VCOS_THREAD_T **)to_current_vcos_thread();
+
+ /* If we find this, either the thread is already dead or stack pages of a
+ * dead vcos thread are re-allocated to this one.
+ *
+ * Since there's no way to differentiate between these 2 cases, we just dump
+ * the current task name to the log.
+ *
+ * If the current thread is created using VCOS API, you should *never* see this
+ * print.
+ *
+ * If its a non-VCOS thread, just let it go ...
+ *
+ * To debug VCOS, uncomment printk's under the "if" condition below
+ *
+ */
+ if (*vcos_thread_storage == (void *)0xCAFEBABE)
+ {
+ #if 0
+ printk(KERN_DEBUG"****************************************************\n");
+ printk(KERN_DEBUG"%s : You have a problem, if \"%s\" is a VCOS thread\n",__func__, current->comm);
+ printk(KERN_DEBUG"****************************************************\n");
+ #endif
+ }
+
+ return *vcos_thread_storage;
+}
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/linuxkernel/vcos_thread_map.h
@@ -0,0 +1,39 @@
+/*****************************************************************************
+* Copyright 2009 - 2010 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+
+#ifndef VCOS_THREAD_MAP_H
+#define VCOS_THREAD_MAP_H
+
+#include <linux/string.h>
+
+#include "vcos_platform.h"
+
+static inline void vcos_thread_map_init(void)
+{
+ return;
+}
+
+static inline void vcos_thread_map_cleanup(void)
+{
+ return;
+}
+
+uint32_t vcos_add_thread(VCOS_THREAD_T *vcos_thread);
+
+uint32_t vcos_remove_thread(struct task_struct *thread_id);
+
+VCOS_THREAD_T *vcos_kthread_current(void);
+
+#endif /*VCOS_THREAD_MAP_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos.h
@@ -0,0 +1,201 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+/**
+ * \mainpage OS Abstraction Layer
+ *
+ * \section intro Introduction
+ *
+ * This abstraction layer is here to allow the underlying OS to be easily changed (e.g. from
+ * Nucleus to ThreadX) and to aid in porting host applications to new targets.
+ *
+ * \subsection error Error handling
+ *
+ * Wherever possible, VCOS functions assert internally and return void. The only exceptions
+ * are creation functions (which might fail due to lack of resources) and functions that
+ * might timeout or fail due to lack of space. Errors that might be reported by the underlying
+ * OS API (e.g. invalid mutex) are treated as a programming error, and are merely asserted on.
+ *
+ * \section thread_synch Threads and synchronisation
+ *
+ * \subsection thread Threads
+ *
+ * The thread API is somewhat different to that found in Nucleus. In particular, threads
+ * cannot just be destroyed at arbitrary times and nor can they merely exit. This is so
+ * that the same API can be implemented across all interesting platforms without too much
+ * difficulty. See vcos_thread.h for details. Thread attributes are configured via
+ * the VCOS_THREAD_ATTR_T structure, found in vcos_thread_attr.h.
+ *
+ * \subsection sema Semaphores
+ *
+ * Counted semaphores (c.f. Nucleus NU_SEMAPHORE) are created with VCOS_SEMAPHORE_T.
+ * Under ThreadX on VideoCore, semaphores are implemented using VideoCore spinlocks, and
+ * so are quite a lot faster than ordinary ThreadX semaphores. See vcos_semaphore.h.
+ *
+ * \subsection mtx Mutexes
+ *
+ * Mutexes are used for locking. Attempts to take a mutex twice, or to unlock it
+ * in a different thread to the one in which it was locked should be expected to fail.
+ * Mutexes are not re-entrant (see vcos_reentrant_mutex.h for a slightly slower
+ * re-entrant mutex).
+ *
+ * \subsection evflags Event flags
+ *
+ * Event flags (the ThreadX name - also known as event groups under Nucleus) provide
+ * 32 flags which can be waited on by multiple clients, and signalled by multiple clients.
+ * A timeout can be specified. See vcos_event_flags.h. An alternative to this is the
+ * VCOS_EVENT_T (see vcos_event.h) which is akin to the Win32 auto-reset event, or a
+ * saturating counted semaphore.
+ *
+ * \subsection event Events
+ *
+ * A VCOS_EVENT_T is a bit like a saturating semaphore. No matter how many times it
+ * is signalled, the waiter will only wake up once. See vcos_event.h. You might think this
+ * is useful if you suspect that the cost of reading the semaphore count (perhaps via a
+ * system call) is expensive on your platform.
+ *
+ * \subsection tls Thread local storage
+ *
+ * Thread local storage is supported using vcos_tls.h. This is emulated on Nucleus
+ * and ThreadX.
+ *
+ * \section int Interrupts
+ *
+ * The legacy LISR/HISR scheme found in Nucleus is supported via the legacy ISR API,
+ * which is also supported on ThreadX. New code should avoid this, and old code should
+ * be migrated away from it, since it is slow. See vcos_legacy_isr.h.
+ *
+ * Registering an interrupt handler, and disabling/restoring interrupts, is handled
+ * using the functions in vcos_isr.h.
+ *
+ */
+
+/**
+ * \file vcos.h
+ *
+ * This is the top level header file. Clients include this. It pulls in the platform-specific
+ * header file (vcos_platform.h) together with header files defining the expected APIs, such
+ * as vcos_mutex.h, vcos_semaphore.h, etc. It is also possible to include these header files
+ * directly.
+ *
+ */
+
+#ifndef VCOS_H
+#define VCOS_H
+
+#include "interface/vcos/vcos_assert.h"
+#include "vcos_types.h"
+#include "vcos_platform.h"
+
+#ifndef VCOS_INIT_H
+#include "interface/vcos/vcos_init.h"
+#endif
+
+#ifndef VCOS_SEMAPHORE_H
+#include "interface/vcos/vcos_semaphore.h"
+#endif
+
+#ifndef VCOS_THREAD_H
+#include "interface/vcos/vcos_thread.h"
+#endif
+
+#ifndef VCOS_MUTEX_H
+#include "interface/vcos/vcos_mutex.h"
+#endif
+
+#ifndef VCOS_MEM_H
+#include "interface/vcos/vcos_mem.h"
+#endif
+
+#ifndef VCOS_LOGGING_H
+#include "interface/vcos/vcos_logging.h"
+#endif
+
+#ifndef VCOS_STRING_H
+#include "interface/vcos/vcos_string.h"
+#endif
+
+#ifndef VCOS_EVENT_H
+#include "interface/vcos/vcos_event.h"
+#endif
+
+#ifndef VCOS_THREAD_ATTR_H
+#include "interface/vcos/vcos_thread_attr.h"
+#endif
+
+#ifndef VCOS_TLS_H
+#include "interface/vcos/vcos_tls.h"
+#endif
+
+#ifndef VCOS_REENTRANT_MUTEX_H
+#include "interface/vcos/vcos_reentrant_mutex.h"
+#endif
+
+#ifndef VCOS_NAMED_SEMAPHORE_H
+#include "interface/vcos/vcos_named_semaphore.h"
+#endif
+
+#ifndef VCOS_QUICKSLOW_MUTEX_H
+#include "interface/vcos/vcos_quickslow_mutex.h"
+#endif
+
+/* Headers with predicates */
+
+#if VCOS_HAVE_EVENT_FLAGS
+#include "interface/vcos/vcos_event_flags.h"
+#endif
+
+#if VCOS_HAVE_QUEUE
+#include "interface/vcos/vcos_queue.h"
+#endif
+
+#if VCOS_HAVE_LEGACY_ISR
+#include "interface/vcos/vcos_legacy_isr.h"
+#endif
+
+#if VCOS_HAVE_TIMER
+#include "interface/vcos/vcos_timer.h"
+#endif
+
+#if VCOS_HAVE_MEMPOOL
+#include "interface/vcos/vcos_mempool.h"
+#endif
+
+#if VCOS_HAVE_ISR
+#include "interface/vcos/vcos_isr.h"
+#endif
+
+#if VCOS_HAVE_ATOMIC_FLAGS
+#include "interface/vcos/vcos_atomic_flags.h"
+#endif
+
+#if VCOS_HAVE_ONCE
+#include "interface/vcos/vcos_once.h"
+#endif
+
+#if VCOS_HAVE_BLOCK_POOL
+#include "interface/vcos/vcos_blockpool.h"
+#endif
+
+#if VCOS_HAVE_FILE
+#include "interface/vcos/vcos_file.h"
+#endif
+
+#if VCOS_HAVE_CFG
+#include "interface/vcos/vcos_cfg.h"
+#endif
+
+#if VCOS_HAVE_CMD
+#include "interface/vcos/vcos_cmd.h"
+#endif
+
+#endif /* VCOS_H */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_assert.h
@@ -0,0 +1,269 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : osal
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - Assertion and error-handling macros.
+=============================================================================*/
+
+
+#ifndef VCOS_ASSERT_H
+#define VCOS_ASSERT_H
+
+/*
+ * Macro:
+ * vcos_assert(cond)
+ * vcos_assert_msg(cond, fmt, ...)
+ * Use:
+ * Detecting programming errors by ensuring that assumptions are correct.
+ * On failure:
+ * Performs a platform-dependent "breakpoint", usually with an assert-style
+ * message. The '_msg' variant expects a printf-style format string and
+ * parameters.
+ * If a failure is detected, the code should be fixed and rebuilt.
+ * In release builds:
+ * Generates no code, i.e. does not evaluate 'cond'.
+ * Returns:
+ * Nothing.
+ *
+ * Macro:
+ * vcos_demand(cond)
+ * vcos_demand_msg(cond, fmt, ...)
+ * Use:
+ * Detecting fatal system errors that require a reboot.
+ * On failure:
+ * Performs a platform-dependent "breakpoint", usually with an assert-style
+ * message, then calls vcos_abort (see below).
+ * In release builds:
+ * Calls vcos_abort() if 'cond' is false.
+ * Returns:
+ * Nothing (never, on failure).
+ *
+ * Macro:
+ * vcos_verify(cond)
+ * vcos_verify_msg(cond, fmt, ...)
+ * Use:
+ * Detecting run-time errors and interesting conditions, normally within an
+ * 'if' statement to catch the failures, i.e.
+ * if (!vcos_verify(cond)) handle_error();
+ * On failure:
+ * Generates a message and optionally stops at a platform-dependent
+ * "breakpoint" (usually disabled). See vcos_verify_bkpts_enable below.
+ * In release builds:
+ * Just evaluates and returns 'cond'.
+ * Returns:
+ * Non-zero if 'cond' is true, otherwise zero.
+ *
+ * Macro:
+ * vcos_static_assert(cond)
+ * Use:
+ * Detecting compile-time errors.
+ * On failure:
+ * Generates a compiler error.
+ * In release builds:
+ * Generates a compiler error.
+ *
+ * Function:
+ * void vcos_abort(void)
+ * Use:
+ * Invokes the fatal error handling mechanism, alerting the host where
+ * applicable.
+ * Returns:
+ * Never.
+ *
+ * Macro:
+ * VCOS_VERIFY_BKPTS
+ * Use:
+ * Define in a module (before including vcos.h) to specify an alternative
+ * flag to control breakpoints on vcos_verify() failures.
+ * Returns:
+ * Non-zero values enable breakpoints.
+ *
+ * Function:
+ * int vcos_verify_bkpts_enable(int enable);
+ * Use:
+ * Sets the global flag controlling breakpoints on vcos_verify failures,
+ * enabling the breakpoints iff 'enable' is non-zero.
+ * Returns:
+ * The previous state of the flag.
+ *
+ * Function:
+ * int vcos_verify_bkpts_enabled(void);
+ * Use:
+ * Queries the state of the global flag enabling breakpoints on vcos_verify
+ * failures.
+ * Returns:
+ * The current state of the flag.
+ *
+ * Examples:
+ *
+ * int my_breakpoint_enable_flag = 1;
+ *
+ * #define VCOS_VERIFY_BKPTS my_breakpoint_enable_flag
+ *
+ * #include "interface/vcos/vcos.h"
+ *
+ * vcos_static_assert((sizeof(object) % 32) == 0);
+ *
+ * // ...
+ *
+ * vcos_assert_msg(postcondition_is_true, "Coding error");
+ *
+ * if (!vcos_verify_msg(buf, "Buffer allocation failed (%d bytes)", size))
+ * {
+ * // Tidy up
+ * // ...
+ * return OUT_OF_MEMORY;
+ * }
+ *
+ * vcos_demand(*p++==GUARDWORDHEAP);
+ */
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+
+#ifdef __COVERITY__
+#undef VCOS_ASSERT_BKPT
+#define VCOS_ASSERT_BKPT __coverity_panic__()
+#endif
+
+#ifndef VCOS_VERIFY_BKPTS
+#define VCOS_VERIFY_BKPTS vcos_verify_bkpts_enabled()
+#endif
+
+#ifndef VCOS_BKPT
+#if defined(__VIDEOCORE__) && !defined(VCOS_ASSERT_NO_BKPTS)
+#define VCOS_BKPT _bkpt()
+#else
+#define VCOS_BKPT (void )0
+#endif
+#endif
+
+#ifndef VCOS_ASSERT_BKPT
+#define VCOS_ASSERT_BKPT VCOS_BKPT
+#endif
+
+#ifndef VCOS_VERIFY_BKPT
+#define VCOS_VERIFY_BKPT (VCOS_VERIFY_BKPTS ? VCOS_BKPT : (void)0)
+#endif
+
+VCOSPRE_ int VCOSPOST_ vcos_verify_bkpts_enabled(void);
+VCOSPRE_ int VCOSPOST_ vcos_verify_bkpts_enable(int enable);
+VCOSPRE_ void VCOSPOST_ vcos_abort(void);
+
+#ifndef VCOS_ASSERT_MSG
+#ifdef LOGGING
+extern void logging_assert(const char *file, const char *func, int line, const char *format, ...);
+#define VCOS_ASSERT_MSG(...) ((VCOS_ASSERT_LOGGING && !VCOS_ASSERT_LOGGING_DISABLE) ? logging_assert(__FILE__, __func__, __LINE__, __VA_ARGS__) : (void)0)
+#else
+#define VCOS_ASSERT_MSG(...) ((void)0)
+#endif
+#endif
+
+#ifndef VCOS_VERIFY_MSG
+#define VCOS_VERIFY_MSG(...) VCOS_ASSERT_MSG(__VA_ARGS__)
+#endif
+
+#ifndef VCOS_ASSERT_LOGGING
+#define VCOS_ASSERT_LOGGING 0
+#endif
+
+#ifndef VCOS_ASSERT_LOGGING_DISABLE
+#define VCOS_ASSERT_LOGGING_DISABLE 0
+#endif
+
+#if !defined(NDEBUG) || defined(VCOS_RELEASE_ASSERTS)
+
+#ifndef vcos_assert
+#define vcos_assert(cond) \
+ ( (cond) ? (void)0 : (VCOS_ASSERT_MSG("%s", #cond), VCOS_ASSERT_BKPT) )
+#endif
+
+#ifndef vcos_assert_msg
+#define vcos_assert_msg(cond, ...) \
+ ( (cond) ? (void)0 : (VCOS_ASSERT_MSG(__VA_ARGS__), VCOS_ASSERT_BKPT) )
+#endif
+
+#else /* !defined(NDEBUG) || defined(VCOS_RELEASE_ASSERTS) */
+
+#ifndef vcos_assert
+#define vcos_assert(cond) (void)0
+#endif
+
+#ifndef vcos_assert_msg
+#define vcos_assert_msg(cond, ...) (void)0
+#endif
+
+#endif /* !defined(NDEBUG) || defined(VCOS_RELEASE_ASSERTS) */
+
+#if !defined(NDEBUG)
+
+#ifndef vcos_demand
+#define vcos_demand(cond) \
+ ( (cond) ? (void)0 : (VCOS_ASSERT_MSG("%s", #cond), VCOS_ASSERT_BKPT, vcos_abort()) )
+#endif
+
+#ifndef vcos_demand_msg
+#define vcos_demand_msg(cond, ...) \
+ ( (cond) ? (void)0 : (VCOS_ASSERT_MSG(__VA_ARGS__), VCOS_ASSERT_BKPT, vcos_abort()) )
+#endif
+
+#ifndef vcos_verify
+#define vcos_verify(cond) \
+ ( (cond) ? 1 : (VCOS_VERIFY_MSG("%s", #cond), VCOS_VERIFY_BKPT, 0) )
+#endif
+
+#ifndef vcos_verify_msg
+#define vcos_verify_msg(cond, ...) \
+ ( (cond) ? 1 : (VCOS_VERIFY_MSG(__VA_ARGS__), VCOS_VERIFY_BKPT, 0) )
+#endif
+
+#else /* !defined(NDEBUG) */
+
+#ifndef vcos_demand
+#define vcos_demand(cond) \
+ ( (cond) ? (void)0 : vcos_abort() )
+#endif
+
+#ifndef vcos_demand_msg
+#define vcos_demand_msg(cond, ...) \
+ ( (cond) ? (void)0 : vcos_abort() )
+#endif
+
+#ifndef vcos_verify
+#define vcos_verify(cond) (cond)
+#endif
+
+#ifndef vcos_verify_msg
+#define vcos_verify_msg(cond, ...) (cond)
+#endif
+
+#endif /* !defined(NDEBUG) */
+
+#ifndef vcos_static_assert
+#if defined(__GNUC__)
+#define vcos_static_assert(cond) __attribute__((unused)) extern int vcos_static_assert[(cond)?1:-1]
+#else
+#define vcos_static_assert(cond) extern int vcos_static_assert[(cond)?1:-1]
+#endif
+#endif
+
+#ifndef vc_assert
+#define vc_assert(cond) vcos_assert(cond)
+#endif
+
+/** Print out a backtrace, on supported platforms.
+ */
+extern void vcos_backtrace_self(void);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* VCOS_ASSERT_H */
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_atomic_flags.h
@@ -0,0 +1,72 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver (just for consistency with the rest of vcos ;)
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_ATOMIC_FLAGS_H
+#define VCOS_ATOMIC_FLAGS_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file vcos_atomic_flags.h
+ *
+ * Defines atomic flags API.
+ *
+ * 32 flags. Atomic "or" and "get and clear" operations
+ */
+
+/**
+ * Create an atomic flags instance.
+ *
+ * @param atomic_flags Pointer to atomic flags instance, filled in on return
+ *
+ * @return VCOS_SUCCESS if succeeded.
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_atomic_flags_create(VCOS_ATOMIC_FLAGS_T *atomic_flags);
+
+/**
+ * Atomically set the specified flags.
+ *
+ * @param atomic_flags Instance to set flags on
+ * @param flags Mask of flags to set
+ */
+VCOS_INLINE_DECL
+void vcos_atomic_flags_or(VCOS_ATOMIC_FLAGS_T *atomic_flags, uint32_t flags);
+
+/**
+ * Retrieve the current flags and then clear them. The entire operation is
+ * atomic.
+ *
+ * @param atomic_flags Instance to get/clear flags from/on
+ *
+ * @return Mask of flags which were set (and we cleared)
+ */
+VCOS_INLINE_DECL
+uint32_t vcos_atomic_flags_get_and_clear(VCOS_ATOMIC_FLAGS_T *atomic_flags);
+
+/**
+ * Delete an atomic flags instance.
+ *
+ * @param atomic_flags Instance to delete
+ */
+VCOS_INLINE_DECL
+void vcos_atomic_flags_delete(VCOS_ATOMIC_FLAGS_T *atomic_flags);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_build_info.h
@@ -0,0 +1,5 @@
+const char *vcos_get_build_hostname( void );
+const char *vcos_get_build_version( void );
+const char *vcos_get_build_time( void );
+const char *vcos_get_build_date( void );
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_cfg.h
@@ -0,0 +1,113 @@
+/*****************************************************************************
+* Copyright 2009 - 2011 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#if !defined( VCOS_CFG_H )
+#define VCOS_CFG_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+typedef struct opaque_vcos_cfg_buf_t *VCOS_CFG_BUF_T;
+typedef struct opaque_vcos_cfg_entry_t *VCOS_CFG_ENTRY_T;
+
+/** \file vcos_file.h
+ *
+ * API for accessing configuration/statistics information. This
+ * is loosely modelled on the linux proc entries.
+ */
+
+typedef void (*VCOS_CFG_SHOW_FPTR)( VCOS_CFG_BUF_T buf, void *data );
+typedef void (*VCOS_CFG_PARSE_FPTR)( VCOS_CFG_BUF_T buf, void *data );
+
+/** Create a configuration directory.
+ *
+ * @param entry Place to store the created config entry.
+ * @param parent Parent entry (for directory like config
+ * options).
+ * @param entryName Name of the directory.
+ */
+
+VCOS_STATUS_T vcos_cfg_mkdir( VCOS_CFG_ENTRY_T *entry,
+ VCOS_CFG_ENTRY_T *parent,
+ const char *dirName );
+
+/** Create a configuration entry.
+ *
+ * @param entry Place to store the created config entry.
+ * @param parent Parent entry (for directory like config
+ * options).
+ * @param entryName Name of the configuration entry.
+ * @param showFunc Function pointer to show configuration
+ * data.
+ * @param parseFunc Function pointer to parse new data.
+ */
+
+VCOS_STATUS_T vcos_cfg_create_entry( VCOS_CFG_ENTRY_T *entry,
+ VCOS_CFG_ENTRY_T *parent,
+ const char *entryName,
+ VCOS_CFG_SHOW_FPTR showFunc,
+ VCOS_CFG_PARSE_FPTR parseFunc,
+ void *data );
+
+/** Determines if a configuration entry has been created or not.
+ *
+ * @param entry Configuration entry to query.
+ */
+
+int vcos_cfg_is_entry_created( VCOS_CFG_ENTRY_T entry );
+
+/** Returns the name of a configuration entry.
+ *
+ * @param entry Configuration entry to query.
+ */
+
+const char *vcos_cfg_get_entry_name( VCOS_CFG_ENTRY_T entry );
+
+/** Removes a configuration entry.
+ *
+ * @param entry Configuration entry to remove.
+ */
+
+VCOS_STATUS_T vcos_cfg_remove_entry( VCOS_CFG_ENTRY_T *entry );
+
+
+/** Writes data into a configuration buffer. Only valid inside
+ * the show function.
+ *
+ * @param buf Buffer to write data into.
+ * @param fmt printf style format string.
+ */
+
+void vcos_cfg_buf_printf( VCOS_CFG_BUF_T buf, const char *fmt, ... );
+
+/** Retrieves a null terminated string of the data associated
+ * with the buffer. Only valid inside the parse function.
+ *
+ * @param buf Buffer to get data from.
+ * @param fmt printf style format string.
+ */
+
+char *vcos_cfg_buf_get_str( VCOS_CFG_BUF_T buf );
+
+void *vcos_cfg_get_proc_entry( VCOS_CFG_ENTRY_T entry );
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_cmd.h
@@ -0,0 +1,98 @@
+/*****************************************************************************
+* Copyright 2009 - 2011 Broadcom Corporation. All rights reserved.
+*
+* Unless you and Broadcom execute a separate written software license
+* agreement governing use of this software, this software is licensed to you
+* under the terms of the GNU General Public License version 2, available at
+* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
+*
+* Notwithstanding the above, under no circumstances may you combine this
+* software in any way with any other Broadcom software provided under a
+* license other than the GPL, without Broadcom's express prior written
+* consent.
+*****************************************************************************/
+
+#if !defined( VCOS_CMD_H )
+#define VCOS_CMD_H
+
+/* ---- Include Files ----------------------------------------------------- */
+
+#include "interface/vcos/vcos.h"
+#include "interface/vcos/vcos_stdint.h"
+
+
+/* ---- Constants and Types ---------------------------------------------- */
+
+struct VCOS_CMD_S;
+typedef struct VCOS_CMD_S VCOS_CMD_T;
+
+typedef struct
+{
+ int argc; /* Number of arguments (includes the command/sub-command) */
+ char **argv; /* Array of arguments */
+ char **argv_orig; /* Original array of arguments */
+
+ VCOS_CMD_T *cmd_entry;
+ VCOS_CMD_T *cmd_parent_entry;
+
+ int use_log; /* Output being logged? */
+ size_t result_size; /* Size of result buffer. */
+ char *result_ptr; /* Next place to put output. */
+ char *result_buf; /* Start of the buffer. */
+
+} VCOS_CMD_PARAM_T;
+
+typedef VCOS_STATUS_T (*VCOS_CMD_FUNC_T)( VCOS_CMD_PARAM_T *param );
+
+struct VCOS_CMD_S
+{
+ const char *name;
+ const char *args;
+ VCOS_CMD_FUNC_T cmd_fn;
+ VCOS_CMD_T *sub_cmd_entry;
+ const char *descr;
+
+};
+
+/* ---- Variable Externs ------------------------------------------------- */
+
+/* ---- Function Prototypes ---------------------------------------------- */
+
+/*
+ * Common printing routine for generating command output.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_cmd_error( VCOS_CMD_PARAM_T *param, const char *fmt, ... ) VCOS_FORMAT_ATTR_(printf, 2, 3);
+VCOSPRE_ void VCOSPOST_ vcos_cmd_printf( VCOS_CMD_PARAM_T *param, const char *fmt, ... ) VCOS_FORMAT_ATTR_(printf, 2, 3);
+VCOSPRE_ void VCOSPOST_ vcos_cmd_vprintf( VCOS_CMD_PARAM_T *param, const char *fmt, va_list args ) VCOS_FORMAT_ATTR_(printf, 2, 0);
+
+/*
+ * Cause vcos_cmd_error, printf and vprintf to always log to the provided
+ * category. When this call is made, the results buffer passed into
+ * vcos_cmd_execute is used as a line buffer and does not need to be
+ * output by the caller.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_cmd_always_log_output( VCOS_LOG_CAT_T *log_category );
+
+/*
+ * Prints command usage for the current command.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_cmd_usage( VCOS_CMD_PARAM_T *param );
+
+/*
+ * Register commands to be processed
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_cmd_register( VCOS_CMD_T *cmd_entry );
+
+/*
+ * Registers multiple commands to be processed. The array should
+ * be terminated by an entry with all zeros.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_cmd_register_multiple( VCOS_CMD_T *cmd_entry );
+
+/*
+ * Executes a command based on a command line.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_cmd_execute( int argc, char **argv, size_t result_size, char *result_buf );
+
+#endif /* VCOS_CMD_H */
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_ctype.h
@@ -0,0 +1,29 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_CTYPE_H
+#define VCOS_CTYPE_H
+
+/**
+ * \file
+ *
+ * ctype functions.
+ *
+ */
+
+#ifdef __KERNEL__
+#include <linux/ctype.h>
+#else
+#include <ctype.h>
+#endif
+
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_dlfcn.h
@@ -0,0 +1,69 @@
+/*=============================================================================
+Copyright (c) 2010 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VCOS - abstraction over dynamic library opening
+=============================================================================*/
+
+#ifndef VCOS_DLFCN_H
+#define VCOS_DLFCN_H
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#define VCOS_DL_LAZY 1
+#define VCOS_DL_NOW 2
+
+/**
+ * \file
+ *
+ * Loading dynamic libraries. See also dlfcn.h.
+ */
+
+/** Open a dynamic library.
+ *
+ * @param name name of the library
+ * @param mode Load lazily or immediately (VCOS_DL_LAZY, VCOS_DL_NOW).
+ *
+ * @return A handle for use in subsequent calls.
+ */
+VCOSPRE_ void * VCOSPOST_ vcos_dlopen(const char *name, int mode);
+
+/** Look up a symbol.
+ *
+ * @param handle Handle to open
+ * @param name Name of function
+ *
+ * @return Function pointer, or NULL.
+ */
+VCOSPRE_ void VCOSPOST_ (*vcos_dlsym(void *handle, const char *name))(void);
+
+/** Close a library
+ *
+ * @param handle Handle to close
+ */
+VCOSPRE_ int VCOSPOST_ vcos_dlclose (void *handle);
+
+/** Return error message from library.
+ *
+ * @param err On return, set to non-zero if an error has occurred
+ * @param buf Buffer to write error to
+ * @param len Size of buffer (including terminating NUL).
+ */
+VCOSPRE_ int VCOSPOST_ vcos_dlerror(int *err, char *buf, size_t buflen);
+
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_event.h
@@ -0,0 +1,97 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file for events
+=============================================================================*/
+
+#ifndef VCOS_EVENT_H
+#define VCOS_EVENT_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file
+ *
+ * An event is akin to the Win32 auto-reset event.
+ *
+ *
+ * Signalling an event will wake up one waiting thread only. Once one
+ * thread has been woken the event atomically returns to the unsignalled
+ * state.
+ *
+ * If no threads are waiting on the event when it is signalled it remains
+ * signalled.
+ *
+ * This is almost, but not quite, completely unlike the "event flags"
+ * object based on Nucleus event groups and ThreadX event flags.
+ *
+ * In particular, it should be similar in speed to a semaphore, unlike
+ * the event flags.
+ */
+
+/**
+ * Create an event instance.
+ *
+ * @param event Filled in with constructed event.
+ * @param name Name of the event (for debugging)
+ *
+ * @return VCOS_SUCCESS on success, or error code.
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_create(VCOS_EVENT_T *event, const char *name);
+
+#ifndef vcos_event_signal
+
+/**
+ * Signal the event. The event will return to being unsignalled
+ * after exactly one waiting thread has been woken up. If no
+ * threads are waiting it remains signalled.
+ *
+ * @param event The event to signal
+ */
+VCOS_INLINE_DECL
+void vcos_event_signal(VCOS_EVENT_T *event);
+
+/**
+ * Wait for the event.
+ *
+ * @param event The event to wait for
+ * @return VCOS_SUCCESS on success, VCOS_EAGAIN if the wait was interrupted.
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_wait(VCOS_EVENT_T *event);
+
+/**
+ * Try event, but don't block.
+ *
+ * @param event The event to try
+ * @return VCOS_SUCCESS on success, VCOS_EAGAIN if the event is not currently signalled
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_try(VCOS_EVENT_T *event);
+
+#endif
+
+/*
+ * Destroy an event.
+ */
+VCOS_INLINE_DECL
+void vcos_event_delete(VCOS_EVENT_T *event);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_event_flags.h
@@ -0,0 +1,98 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_EVENT_FLAGS_H
+#define VCOS_EVENT_FLAGS_H
+
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+#define VCOS_EVENT_FLAGS_SUSPEND VCOS_SUSPEND
+#define VCOS_EVENT_FLAGS_NO_SUSPEND VCOS_NO_SUSPEND
+typedef VCOS_OPTION VCOS_EVENTGROUP_OPERATION_T;
+
+/**
+ * \file vcos_event_flags.h
+ *
+ * Defines event flags API.
+ *
+ * Similar to Nucleus event groups.
+ *
+ * These have the same semantics as Nucleus event groups and ThreadX event
+ * flags. As such, they are quite complex internally; if speed is important
+ * they might not be your best choice.
+ *
+ */
+
+/**
+ * Create an event flags instance.
+ *
+ * @param flags Pointer to event flags instance, filled in on return.
+ * @param name Name for the event flags, used for debug.
+ *
+ * @return VCOS_SUCCESS if succeeded.
+ */
+
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_flags_create(VCOS_EVENT_FLAGS_T *flags, const char *name);
+
+/**
+ * Set some events.
+ *
+ * @param flags Instance to set flags on
+ * @param events Bitmask of the flags to actually set
+ * @param op How the flags should be set. VCOS_OR will OR in the flags; VCOS_AND
+ * will AND them in, possibly clearing existing flags.
+ */
+VCOS_INLINE_DECL
+void vcos_event_flags_set(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED events,
+ VCOS_OPTION op);
+
+/**
+ * Retrieve some events.
+ *
+ * Waits until the specified events have been set.
+ *
+ * @param flags Instance to wait on
+ * @param requested_events The bitmask to wait for
+ * @param op VCOS_OR - get any; VCOS_AND - get all.
+ * @param ms_suspend How long to wait, in milliseconds
+ * @param retrieved_events the events actually retrieved.
+ *
+ * @return VCOS_SUCCESS if events were retrieved. VCOS_EAGAIN if the
+ * timeout expired.
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_event_flags_get(VCOS_EVENT_FLAGS_T *flags,
+ VCOS_UNSIGNED requested_events,
+ VCOS_OPTION op,
+ VCOS_UNSIGNED ms_suspend,
+ VCOS_UNSIGNED *retrieved_events);
+
+
+/**
+ * Delete an event flags instance.
+ */
+VCOS_INLINE_DECL
+void vcos_event_flags_delete(VCOS_EVENT_FLAGS_T *);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_init.h
@@ -0,0 +1,43 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - initialization routines
+=============================================================================*/
+
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/** \file
+ *
+ * Some OS support libraries need some initialization. To support this, call this
+ * function at the start of day.
+ */
+
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_init(void);
+VCOSPRE_ void VCOSPOST_ vcos_deinit(void);
+VCOSPRE_ void VCOSPOST_ vcos_global_lock(void);
+VCOSPRE_ void VCOSPOST_ vcos_global_unlock(void);
+
+/** Pass in the argv/argc arguments passed to main() */
+VCOSPRE_ void VCOSPOST_ vcos_set_args(int argc, const char **argv);
+
+/** Return argc. */
+VCOSPRE_ int VCOSPOST_ vcos_get_argc(void);
+
+/** Return argv. */
+VCOSPRE_ const char ** VCOSPOST_ vcos_get_argv(void);
+
+#ifdef __cplusplus
+}
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_logging.h
@@ -0,0 +1,279 @@
+/*=============================================================================
+Copyright (c) 2009-2011 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - logging support
+=============================================================================*/
+
+#ifndef VCOS_LOGGING_H
+#define VCOS_LOGGING_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include <stdarg.h>
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file
+ *
+ * Logging support
+ *
+ * This provides categorised logging. Clients register
+ * a category, and then get a number of logging levels for
+ * that category.
+ *
+ * The logging level flag is tested using a flag *before* the
+ * function call, which makes logging very fast when disabled - there
+ * is no function call overhead just to find out that this log
+ * message is disabled.
+ *
+ * \section VCOS_LOG_CATEGORY
+ *
+ * As a convenience, clients define VCOS_LOG_CATEGORY to point to
+ * their category; the various vcos_log_xxx() macros then expand to
+ * use this.
+ *
+ * e.g.
+ *
+ * #define VCOS_LOG_CATEGORY (&my_category)
+ *
+ * #include <interface/vcos/vcos.h>
+ *
+ * VCOS_LOG_CAT_T my_category;
+ *
+ * ....
+ *
+ * vcos_log_trace("Stuff happened: %d", n_stuff);
+ *
+ */
+
+/** Logging levels */
+typedef enum VCOS_LOG_LEVEL_T
+{
+ VCOS_LOG_UNINITIALIZED = 0,
+ VCOS_LOG_NEVER,
+ VCOS_LOG_ERROR,
+ VCOS_LOG_WARN,
+ VCOS_LOG_INFO,
+ VCOS_LOG_TRACE,
+} VCOS_LOG_LEVEL_T;
+
+
+/** Initialize a logging category without going through vcos_log_register().
+ *
+ * This is useful for the case where there is no obvious point to do the
+ * registration (no initialization function for the module). However, it
+ * means that your logging category is not registered, so cannot be easily
+ * changed at run-time.
+ */
+#define VCOS_LOG_INIT(n,l) { l, n, 0, {0}, 0, 0 }
+
+/** A registered logging category.
+ */
+typedef struct VCOS_LOG_CAT_T
+{
+ VCOS_LOG_LEVEL_T level; /** Which levels are enabled for this category */
+ const char *name; /** Name for this category. */
+ struct VCOS_LOG_CAT_T *next;
+ struct {
+ unsigned int want_prefix:1;
+ } flags;
+ unsigned int refcount;
+ void *platform_data; /** platform specific data */
+} VCOS_LOG_CAT_T;
+
+typedef void (*VCOS_VLOG_IMPL_FUNC_T)(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, va_list args);
+
+/** Convert a VCOS_LOG_LEVEL_T into a printable string.
+ * The platform needs to implement this function.
+ */
+VCOSPRE_ const char * VCOSPOST_ vcos_log_level_to_string( VCOS_LOG_LEVEL_T level );
+
+/** Convert a string into a VCOS_LOG_LEVEL_T
+ * The platform needs to implement this function.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_string_to_log_level( const char *str, VCOS_LOG_LEVEL_T *level );
+
+/** Log a message. Basic API. Normal code should not use this.
+ * The platform needs to implement this function.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_log_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, ...) VCOS_FORMAT_ATTR_(printf, 3, 4);
+
+/** Log a message using a varargs parameter list. Normal code should
+ * not use this.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_vlog_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, va_list args) VCOS_FORMAT_ATTR_(printf, 3, 0);
+
+/** Set the function which does the actual logging output.
+ * Passing in NULL causes the default logging function to be
+ * used.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_set_vlog_impl( VCOS_VLOG_IMPL_FUNC_T vlog_impl_func );
+
+/** The default logging function, which is provided by each
+ * platform.
+ */
+
+VCOSPRE_ void VCOSPOST_ vcos_vlog_default_impl(const VCOS_LOG_CAT_T *cat, VCOS_LOG_LEVEL_T _level, const char *fmt, va_list args) VCOS_FORMAT_ATTR_(printf, 3, 0);
+
+/*
+ * Initialise the logging subsystem. This is called from
+ * vcos_init() so you don't normally need to call it.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_logging_init(void);
+
+/** Register a logging category.
+ *
+ * @param name the name of this category.
+ * @param category the category to register.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_log_register(const char *name, VCOS_LOG_CAT_T *category);
+
+/** Unregister a logging category.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_log_unregister(VCOS_LOG_CAT_T *category);
+
+/** Return a default logging category, for people too lazy to create their own.
+ *
+ * Using the default category will be slow (there's an extra function
+ * call overhead). Don't do this in normal code.
+ */
+VCOSPRE_ const VCOS_LOG_CAT_T * VCOSPOST_ vcos_log_get_default_category(void);
+
+VCOSPRE_ void VCOSPOST_ vcos_set_log_options(const char *opt);
+
+/** Set the logging level for a category at run time. Without this, the level
+ * will be that set by vcos_log_register from a platform-specific source.
+ *
+ * @param category the category to modify.
+ * @param level the new logging level for this category.
+ */
+VCOS_STATIC_INLINE void vcos_log_set_level(VCOS_LOG_CAT_T *category, VCOS_LOG_LEVEL_T level)
+{
+ category->level = level;
+}
+
+#define vcos_log_dump_mem(cat,label,addr,voidMem,numBytes) do { if (vcos_is_log_enabled(cat,VCOS_LOG_TRACE)) vcos_log_dump_mem_impl(cat,label,addr,voidMem,numBytes); } while (0)
+
+void vcos_log_dump_mem_impl( const VCOS_LOG_CAT_T *cat,
+ const char *label,
+ uint32_t addr,
+ const void *voidMem,
+ size_t numBytes );
+
+/*
+ * Platform specific hooks (optional).
+ */
+#ifndef vcos_log_platform_init
+#define vcos_log_platform_init() (void)0
+#endif
+
+#ifndef vcos_log_platform_register
+#define vcos_log_platform_register(category) (void)0
+#endif
+
+#ifndef vcos_log_platform_unregister
+#define vcos_log_platform_unregister(category) (void)0
+#endif
+
+/* VCOS_TRACE() - deprecated macro which just outputs in a debug build and
+ * is a no-op in a release build.
+ *
+ * _VCOS_LOG_X() - internal macro which outputs if the current level for the
+ * particular category is higher than the supplied message level.
+ */
+
+#define VCOS_LOG_DFLT_CATEGORY vcos_log_get_default_category()
+
+#define _VCOS_LEVEL(x) (x)
+
+#define vcos_is_log_enabled(cat,_level) (_VCOS_LEVEL((cat)->level) >= _VCOS_LEVEL(_level))
+
+#if defined(_VCOS_METAWARE) || defined(__GNUC__)
+
+# if !defined(NDEBUG) || defined(VCOS_ALWAYS_WANT_LOGGING)
+# define VCOS_LOGGING_ENABLED
+# define _VCOS_LOG_X(cat, _level, fmt...) do { if (vcos_is_log_enabled(cat,_level)) vcos_log_impl(cat,_level,fmt); } while (0)
+# define _VCOS_VLOG_X(cat, _level, fmt, ap) do { if (vcos_is_log_enabled(cat,_level)) vcos_vlog_impl(cat,_level,fmt,ap); } while (0)
+# else
+# define _VCOS_LOG_X(cat, _level, fmt...) (void)0
+# define _VCOS_VLOG_X(cat, _level, fmt, ap) (void)0
+# endif
+
+
+
+# define vcos_log_error(...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_ERROR, __VA_ARGS__)
+# define vcos_log_warn(...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_WARN, __VA_ARGS__)
+# define vcos_log_info(...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_INFO, __VA_ARGS__)
+# define vcos_log_trace(...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_TRACE, __VA_ARGS__)
+
+# define vcos_vlog_error(fmt,ap) _VCOS_VLOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_ERROR, fmt, ap)
+# define vcos_vlog_warn(fmt,ap) _VCOS_VLOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_WARN, fmt, ap)
+# define vcos_vlog_info(fmt,ap) _VCOS_VLOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_INFO, fmt, ap)
+# define vcos_vlog_trace(fmt,ap) _VCOS_VLOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_TRACE, fmt, ap)
+
+# define vcos_log(...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_INFO, __VA_ARGS__)
+# define vcos_vlog(fmt,ap) _VCOS_VLOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_INFO, fmt, ap)
+# define VCOS_ALERT(...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_ERROR, __VA_ARGS__)
+# define VCOS_TRACE(...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_INFO, __VA_ARGS__)
+
+/*
+ * MS Visual Studio - pre 2005 does not grok variadic macros
+ */
+#elif defined(_MSC_VER)
+
+# if _MSC_VER >= 1400
+
+# if !defined(NDEBUG) || defined(VCOS_ALWAYS_WANT_LOGGING)
+# define VCOS_LOGGING_ENABLED
+# define _VCOS_LOG_X(cat, _level, fmt,...) do { if (vcos_is_log_enabled(cat,_level)) vcos_log_impl(cat, _level, fmt, __VA_ARGS__); } while (0)
+# else
+# define _VCOS_LOG_X(cat, _level, fmt,...) (void)0
+# endif
+
+# define vcos_log_error(fmt,...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_ERROR, fmt, __VA_ARGS__)
+# define vcos_log_warn(fmt,...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_WARN, fmt, __VA_ARGS__)
+# define vcos_log_info(fmt,...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_INFO, fmt, __VA_ARGS__)
+# define vcos_log_trace(fmt,...) _VCOS_LOG_X(VCOS_LOG_CATEGORY, VCOS_LOG_TRACE, fmt, __VA_ARGS__)
+
+# define vcos_log(fmt,...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_INFO, fmt)
+# define VCOS_ALERT(fmt,...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_ERROR, fmt)
+# define VCOS_TRACE(fmt,...) _VCOS_LOG_X(VCOS_LOG_DFLT_CATEGORY, VCOS_LOG_INFO, fmt)
+
+# else /* _MSC_VER >= 1400 */
+
+/* do not define these */
+
+# endif /* _MSC_VER >= 1400 */
+
+#endif
+
+#if VCOS_HAVE_CMD
+
+#include "interface/vcos/vcos_cmd.h"
+
+/*
+ * These are the log sub-commands. They're exported here for user-mode apps which
+ * may want to call these, since the "log" command isn't registered for user-mode
+ * apps (vcdbg for example, has its own log command).
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_log_assert_cmd( VCOS_CMD_PARAM_T *param );
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_log_set_cmd( VCOS_CMD_PARAM_T *param );
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_log_status_cmd( VCOS_CMD_PARAM_T *param );
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_log_test_cmd( VCOS_CMD_PARAM_T *param );
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif /* VCOS_LOGGING_H */
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_lowlevel_thread.h
@@ -0,0 +1,107 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - low level thread support
+=============================================================================*/
+
+#ifndef VCOS_LOWLEVEL_THREAD_H
+#define VCOS_LOWLEVEL_THREAD_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file
+ *
+ * This defines a low level thread API that is supported by *some* operating systems
+ * and can be used to construct the regular "joinable thread" API on those operating
+ * systems.
+ *
+ * Most clients will not need to use this code.
+ *
+ * \sa vcos_joinable_thread.h
+ */
+
+/**
+ * \brief Create a thread.
+ *
+ * This creates a thread which can be stopped either by returning from the
+ * entry point function or by calling vcos_llthread_exit from within the entry
+ * point function. The thread must be cleaned up by calling
+ * vcos_llthread_delete. vcos_llthread_delete may or may not terminate the
+ * thread.
+ *
+ * The preemptible parameter familiar from Nucleus is removed, as it is unused in
+ * VideoCore code. Affinity is added, since we do use this.
+ *
+ * @param thread Filled in with thread instance
+ * @param name An optional name for the thread. "" may be used (but
+ * a name will aid in debugging).
+ * @param entry Entry point
+ * @param arg A single argument passed to the entry point function
+ * @param stack Pointer to stack address
+ * @param stacksz Size of stack in bytes
+ * @param priority Priority of task, between VCOS_PRI_LOW and VCOS_PRI_HIGH
+ * @param affinity CPU affinity
+ *
+ * @sa vcos_llthread_terminate vcos_llthread_delete
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_llthread_create(VCOS_LLTHREAD_T *thread,
+ const char *name,
+ VCOS_LLTHREAD_ENTRY_FN_T entry,
+ void *arg,
+ void *stack,
+ VCOS_UNSIGNED stacksz,
+ VCOS_UNSIGNED priority,
+ VCOS_UNSIGNED affinity,
+ VCOS_UNSIGNED timeslice,
+ VCOS_UNSIGNED autostart);
+
+/**
+ * \brief Exits the current thread.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_llthread_exit(void);
+
+/**
+ * \brief Delete a thread. This must be called to cleanup after
+ * vcos_llthread_create. This may or may not terminate the thread.
+ * It does not clean up any resources that may have been
+ * allocated by the thread.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_llthread_delete(VCOS_LLTHREAD_T *thread);
+
+/**
+ * \brief Return current lowlevel thread pointer.
+ */
+VCOS_INLINE_DECL
+VCOS_LLTHREAD_T *vcos_llthread_current(void);
+
+/**
+ * Resume a thread.
+ */
+VCOS_INLINE_DECL
+void vcos_llthread_resume(VCOS_LLTHREAD_T *thread);
+
+VCOSPRE_ int VCOSPOST_ vcos_llthread_running(VCOS_LLTHREAD_T *thread);
+
+/**
+ * \brief Create a VCOS_LLTHREAD_T for the current thread. This is so we can
+ * have VCOS_LLTHREAD_Ts even for threads not originally created by VCOS (eg
+ * the thread that calls vcos_init).
+ */
+extern VCOS_STATUS_T _vcos_llthread_create_attach(VCOS_LLTHREAD_T *thread);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_mem.h
@@ -0,0 +1,81 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - memory support
+=============================================================================*/
+
+#ifndef VCOS_MEM_H
+#define VCOS_MEM_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/** \file
+ *
+ * Memory allocation api (malloc/free equivalents) is for benefit of host
+ * applications. VideoCore code should use rtos_XXX functions.
+ *
+ */
+
+
+/** Allocate memory
+ *
+ * @param size Size of memory to allocate
+ * @param description Description, to aid in debugging. May be ignored internally on some platforms.
+ */
+VCOS_INLINE_DECL
+void *vcos_malloc(VCOS_UNSIGNED size, const char *description);
+
+void *vcos_kmalloc(VCOS_UNSIGNED size, const char *description);
+void *vcos_kcalloc(VCOS_UNSIGNED num, VCOS_UNSIGNED size, const char *description);
+
+/** Allocate cleared memory
+ *
+ * @param num Number of items to allocate.
+ * @param size Size of each item in bytes.
+ * @param description Description, to aid in debugging. May be ignored internally on some platforms.
+ */
+VCOS_INLINE_DECL
+void *vcos_calloc(VCOS_UNSIGNED num, VCOS_UNSIGNED size, const char *description);
+
+/** Free memory
+ *
+ * Free memory that has been allocated.
+ */
+VCOS_INLINE_DECL
+void vcos_free(void *ptr);
+
+void vcos_kfree(void *ptr);
+
+/** Allocate aligned memory
+ *
+ * Allocate memory aligned on the specified boundary.
+ *
+ * @param size Size of memory to allocate
+ * @param description Description, to aid in debugging. May be ignored internally on some platforms.
+ */
+VCOS_INLINE_DECL
+void *vcos_malloc_aligned(VCOS_UNSIGNED size, VCOS_UNSIGNED align, const char *description);
+
+/** Return the amount of free heap memory
+ *
+ */
+VCOS_INLINE_DECL
+unsigned long vcos_get_free_mem(void);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_msgqueue.h
@@ -0,0 +1,157 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VCOS - packet-like messages, based loosely on those found in TRIPOS.
+=============================================================================*/
+
+#ifndef VCOS_MSGQUEUE_H
+#define VCOS_MSGQUEUE_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file
+ *
+ * Packet-like messages, based loosely on those found in TRIPOS and
+ * derivatives thereof.
+ *
+ * A task can send a message *pointer* to another task, where it is
+ * queued on a linked list and the task woken up. The receiving task
+ * consumes all of the messages on its input queue, and optionally
+ * sends back replies using the original message memory.
+ *
+ * A caller can wait for the reply to a specific message - any other
+ * messages that arrive in the meantime are queued separately.
+ *
+ *
+ * All messages have a standard common layout, but the payload area can
+ * be used freely to extend this.
+ */
+
+/** Map the payload portion of a message to a structure pointer.
+ */
+#define VCOS_MSG_DATA(_msg) (void*)((_msg)->data)
+
+/** Standard message ids - FIXME - these need to be done properly! */
+#define VCOS_MSG_N_QUIT 1
+#define VCOS_MSG_N_OPEN 2
+#define VCOS_MSG_N_CLOSE 3
+#define VCOS_MSG_N_PRIVATE (1<<20)
+
+#define VCOS_MSG_REPLY_BIT (1<<31)
+
+/** Make gnuc compiler be happy about pointer punning */
+#ifdef __GNUC__
+#define __VCOS_MAY_ALIAS __attribute__((__may_alias__))
+#else
+#define __VCOS_MAY_ALIAS
+#endif
+
+/** A single message queue.
+ */
+typedef struct VCOS_MSGQUEUE_T
+{
+ struct VCOS_MSG_T *head; /**< head of linked list of messages waiting on this queue */
+ struct VCOS_MSG_T *tail; /**< tail of message queue */
+ VCOS_SEMAPHORE_T sem; /**< thread waits on this for new messages */
+ VCOS_MUTEX_T lock; /**< locks the messages list */
+} VCOS_MSGQUEUE_T;
+
+/** A single message
+ */
+typedef struct VCOS_MSG_T
+{
+ uint32_t code; /**< message code */
+ int error; /**< error status signalled back to caller */
+ VCOS_MSGQUEUE_T *dst; /**< destination queue */
+ VCOS_MSGQUEUE_T *src; /**< source; replies go back to here */
+ struct VCOS_MSG_T *next; /**< next in queue */
+ VCOS_THREAD_T *src_thread; /**< for debug */
+ uint32_t data[25]; /**< payload area */
+} VCOS_MSG_T;
+
+/** An endpoint
+ */
+typedef struct VCOS_MSG_ENDPOINT_T
+{
+ VCOS_MSGQUEUE_T primary; /**< incoming messages */
+ VCOS_MSGQUEUE_T secondary; /**< this is used for waitspecific */
+ char name[32]; /**< name of this endpoint, for find() */
+ struct VCOS_MSG_ENDPOINT_T *next; /**< next in global list of endpoints */
+} VCOS_MSG_ENDPOINT_T;
+#define MSG_REPLY_BIT (1<<31)
+
+/** Initalise the library. Normally called from vcos_init().
+ */
+extern VCOS_STATUS_T vcos_msgq_init(void);
+
+/** Find a message queue by name and get a handle to it.
+ *
+ * @param name the name of the queue to find
+ *
+ * @return The message queue, or NULL if not found.
+ */
+VCOSPRE_ VCOS_MSGQUEUE_T VCOSPOST_ *vcos_msgq_find(const char *name);
+
+/** Wait for a message queue to come into existence. If it already exists,
+ * return immediately, otherwise block.
+ *
+ * On the whole, if you find yourself using this, it is probably a sign
+ * of poor design, since you should create all the server threads first,
+ * and then the client threads. But it is sometimes useful.
+ *
+ * @param name the name of the queue to find
+ * @return The message queue
+ */
+VCOSPRE_ VCOS_MSGQUEUE_T VCOSPOST_ *vcos_msgq_wait(const char *name);
+
+/** Send a message.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_msg_send(VCOS_MSGQUEUE_T *dest, uint32_t code, VCOS_MSG_T *msg);
+
+/** Send a message and wait for a reply.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_msg_sendwait(VCOS_MSGQUEUE_T *queue, uint32_t code, VCOS_MSG_T *msg);
+
+/** Wait for a message on this thread's endpoint.
+ */
+VCOSPRE_ VCOS_MSG_T * VCOSPOST_ vcos_msg_wait(void);
+
+/** Wait for a specific message.
+ */
+VCOS_MSG_T * vcos_msg_wait_specific(VCOS_MSGQUEUE_T *queue, VCOS_MSG_T *msg);
+
+/** Peek for a message on this thread's endpoint, if a message is not available, NULL is
+ returned. If a message is available it will be removed from the endpoint and returned.
+ */
+VCOSPRE_ VCOS_MSG_T * VCOSPOST_ vcos_msg_peek(void);
+
+/** Send a reply to a message
+ */
+VCOSPRE_ void VCOSPOST_ vcos_msg_reply(VCOS_MSG_T *msg);
+
+/** Create an endpoint. Each thread should need no more than one of these - if you
+ * find yourself needing a second one, you've done something wrong.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_msgq_endpoint_create(VCOS_MSG_ENDPOINT_T *ep, const char *name);
+
+/** Destroy an endpoint.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_msgq_endpoint_delete(VCOS_MSG_ENDPOINT_T *ep);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_mutex.h
@@ -0,0 +1,92 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - mutex public header file
+=============================================================================*/
+
+#ifndef VCOS_MUTEX_H
+#define VCOS_MUTEX_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file vcos_mutex.h
+ *
+ * Mutex API. Mutexes are not re-entrant, as supporting this adds extra code
+ * that slows down clients which have been written sensibly.
+ *
+ * \sa vcos_reentrant_mutex.h
+ *
+ */
+
+/** Create a mutex.
+ *
+ * @param m Filled in with mutex on return
+ * @param name A non-null name for the mutex, used for diagnostics.
+ *
+ * @return VCOS_SUCCESS if mutex was created, or error code.
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_mutex_create(VCOS_MUTEX_T *m, const char *name);
+
+/** Delete the mutex.
+ */
+VCOS_INLINE_DECL
+void vcos_mutex_delete(VCOS_MUTEX_T *m);
+
+/**
+ * \brief Wait to claim the mutex.
+ *
+ * On most platforms this always returns VCOS_SUCCESS, and so would ideally be
+ * a void function, however some platforms allow a wait to be interrupted so
+ * it remains non-void.
+ *
+ * Try to obtain the mutex.
+ * @param m Mutex to wait on
+ * @return VCOS_SUCCESS - mutex was taken.
+ * VCOS_EAGAIN - could not take mutex.
+ */
+#ifndef vcos_mutex_lock
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_mutex_lock(VCOS_MUTEX_T *m);
+
+/** Release the mutex.
+ */
+VCOS_INLINE_DECL
+void vcos_mutex_unlock(VCOS_MUTEX_T *m);
+#endif
+
+/** Test if the mutex is already locked.
+ *
+ * @return 1 if mutex is locked, 0 if it is unlocked.
+ */
+VCOS_INLINE_DECL
+int vcos_mutex_is_locked(VCOS_MUTEX_T *m);
+
+/** Obtain the mutex if possible.
+ *
+ * @param m the mutex to try to obtain
+ *
+ * @return VCOS_SUCCESS if mutex is succesfully obtained, or VCOS_EAGAIN
+ * if it is already in use by another thread.
+ */
+#ifndef vcos_mutex_trylock
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_mutex_trylock(VCOS_MUTEX_T *m);
+#endif
+
+
+#ifdef __cplusplus
+}
+#endif
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_once.h
@@ -0,0 +1,42 @@
+/*=============================================================================
+Copyright (c) 2011 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - 'once'
+=============================================================================*/
+
+#ifndef VCOS_ONCE_H
+#define VCOS_ONCE_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file vcos_once.h
+ *
+ * Ensure something is called only once.
+ *
+ * Initialize once_control to VCOS_ONCE_INIT. The first
+ * time this is called, the init_routine will be called. Thereafter
+ * it won't.
+ *
+ * \sa pthread_once()
+ *
+ */
+
+VCOS_STATUS_T vcos_once(VCOS_ONCE_T *once_control,
+ void (*init_routine)(void));
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_semaphore.h
@@ -0,0 +1,115 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_SEMAPHORE_H
+#define VCOS_SEMAPHORE_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file vcos_semaphore.h
+ *
+ * \section sem Semaphores
+ *
+ * This provides counting semaphores. Semaphores are not re-entrant. On sensible
+ * operating systems a semaphore can always be posted but can only be taken in
+ * thread (not interrupt) context. Under Nucleus, a LISR cannot post a semaphore,
+ * although it would not be hard to lift this restriction.
+ *
+ * \subsection timeout Timeout
+ *
+ * On both Nucleus and ThreadX a semaphore can be taken with a timeout. This is
+ * not supported by VCOS because it makes the non-timeout code considerably more
+ * complicated (and hence slower). In the unlikely event that you need a timeout
+ * with a semaphore, and you cannot simply redesign your code to avoid it, use
+ * an event flag (vcos_event_flags.h).
+ *
+ * \subsection sem_nucleus Changes from Nucleus:
+ *
+ * Semaphores are always "FIFO" - i.e. sleeping threads are woken in FIFO order. That's
+ * because:
+ * \arg there's no support for NU_PRIORITY in threadx (though it can be emulated, slowly)
+ * \arg we don't appear to actually consciously use it - for example, Dispmanx uses
+ * it, but all threads waiting are the same priority.
+ *
+ */
+
+/**
+ * \brief Create a semaphore.
+ *
+ * Create a semaphore.
+ *
+ * @param sem Pointer to memory to be initialized
+ * @param name A name for this semaphore. The name may be truncated internally.
+ * @param count The initial count for the semaphore.
+ *
+ * @return VCOS_SUCCESS if the semaphore was created.
+ *
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_semaphore_create(VCOS_SEMAPHORE_T *sem, const char *name, VCOS_UNSIGNED count);
+
+/**
+ * \brief Wait on a semaphore.
+ *
+ * There is no timeout option on a semaphore, as adding this will slow down
+ * implementations on some platforms. If you need that kind of behaviour, use
+ * an event group.
+ *
+ * On most platforms this always returns VCOS_SUCCESS, and so would ideally be
+ * a void function, however some platforms allow a wait to be interrupted so
+ * it remains non-void.
+ *
+ * @param sem Semaphore to wait on
+ * @return VCOS_SUCCESS - semaphore was taken.
+ * VCOS_EAGAIN - could not take semaphore
+ *
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_semaphore_wait(VCOS_SEMAPHORE_T *sem);
+
+/**
+ * \brief Try to wait for a semaphore.
+ *
+ * Try to obtain the semaphore. If it is already taken, return VCOS_TIMEOUT.
+ * @param sem Semaphore to wait on
+ * @return VCOS_SUCCESS - semaphore was taken.
+ * VCOS_EAGAIN - could not take semaphore
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_semaphore_trywait(VCOS_SEMAPHORE_T *sem);
+
+/**
+ * \brief Post a semaphore.
+ *
+ * @param sem Semaphore to wait on
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_semaphore_post(VCOS_SEMAPHORE_T *sem);
+
+/**
+ * \brief Delete a semaphore, releasing any resources consumed by it.
+ *
+ * @param sem Semaphore to wait on
+ */
+VCOS_INLINE_DECL
+void vcos_semaphore_delete(VCOS_SEMAPHORE_T *sem);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_stdbool.h
@@ -0,0 +1,17 @@
+#ifndef VCOS_STDBOOL_H
+#define VCOS_STDBOOL_H
+
+#ifndef __cplusplus
+
+#if defined(__STDC__) && (__STDC_VERSION__ >= 199901L)
+#include <stdbool.h>
+#else
+typedef enum {
+ false,
+ true
+} bool;
+#endif
+
+#endif /* __cplusplus */
+
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_stdint.h
@@ -0,0 +1,193 @@
+/*=============================================================================
+Copyright (c) 2011 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+
+=============================================================================*/
+
+#ifndef VCOS_STDINT_H
+#define VCOS_STDINT_H
+
+/* Attempt to provide the types defined in stdint.h.
+ *
+ * Ideally this would either call out to a platform-specific
+ * header file (e.g. stdint.h) or define the types on a
+ * per-architecture/compiler basis. But for now we just
+ * use #ifdefs.
+ */
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#ifdef __SYMBIAN32__
+
+typedef signed char int8_t;
+typedef unsigned char uint8_t;
+
+typedef signed short int16_t;
+typedef unsigned short uint16_t;
+
+typedef int16_t int_least16_t;
+
+typedef signed long int32_t;
+typedef unsigned long uint32_t;
+
+typedef signed long long int64_t;
+typedef unsigned long long uint64_t;
+
+typedef int32_t intptr_t;
+typedef uint32_t uintptr_t;
+
+typedef int64_t intmax_t;
+typedef uint64_t uintmax_t;
+
+#define INT8_MIN SCHAR_MIN
+#define INT8_MAX SCHAR_MAX
+#define UINT8_MAX UCHAR_MAX
+#define INT16_MIN SHRT_MIN
+#define INT16_MAX SHRT_MAX
+#define UINT16_MAX USHRT_MAX
+#define INT32_MIN LONG_MIN
+#define INT32_MAX LONG_MAX
+#define UINT32_MAX ULONG_MAX
+#define INT64_MIN LLONG_MIN
+#define INT64_MAX LLONG_MAX
+#define UINT64_MAX ULLONG_MAX
+
+#define INTPTR_MIN INT32_MIN
+#define INTPTR_MAX INT32_MAX
+#define UINTPTR_MAX UINT32_MAX
+#define INTMAX_MIN INT64_MIN
+#define INTMAX_MAX INT64_MAX
+#define INT_LEAST16_MAX INT16_MAX
+#define INT_LEAST16_MAX INT16_MAX
+
+/*{{{ C99 types - THIS WHOLE SECTION IS INCOMPATIBLE WITH C99. IT SHOULD RESIDE IN A STDINT.H SINCE THIS FILE GETS USED ON HOST SIDE */
+
+#elif defined( __STDC__ ) && __STDC_VERSION__ >= 199901L
+
+#include <stdint.h>
+
+#elif defined( __GNUC__ )
+
+#include <stdint.h>
+
+#elif defined(_MSC_VER) /* Visual C define equivalent types */
+
+#include <stddef.h> /* Avoids intptr_t being defined in vadefs.h */
+
+typedef __int8 int8_t;
+typedef unsigned __int8 uint8_t;
+
+typedef __int16 int16_t;
+typedef unsigned __int16 uint16_t;
+
+typedef __int32 int32_t;
+typedef unsigned __int32 uint32_t;
+
+typedef __int64 int64_t;
+typedef unsigned __int64 uint64_t;
+typedef uint32_t uintptr_t;
+typedef int64_t intmax_t;
+typedef uint64_t uintmax_t;
+typedef int16_t int_least16_t;
+
+#elif defined (VCMODS_LCC)
+#include <limits.h>
+
+typedef signed char int8_t;
+typedef unsigned char uint8_t;
+
+typedef signed short int16_t;
+typedef unsigned short uint16_t;
+
+typedef signed long int32_t;
+typedef unsigned long uint32_t;
+
+typedef signed long int64_t; /*!!!! PFCD, this means code using 64bit numbers will be broken on the VCE */
+typedef unsigned long uint64_t; /* !!!! PFCD */
+
+typedef int32_t intptr_t;
+typedef uint32_t uintptr_t;
+typedef int64_t intmax_t;
+typedef uint64_t uintmax_t;
+typedef int16_t int_least16_t;
+
+#define INT8_MIN SCHAR_MIN
+#define INT8_MAX SCHAR_MAX
+#define UINT8_MAX UCHAR_MAX
+#define INT16_MIN SHRT_MIN
+#define INT16_MAX SHRT_MAX
+#define UINT16_MAX USHRT_MAX
+#define INT32_MIN LONG_MIN
+#define INT32_MAX LONG_MAX
+#define UINT32_MAX ULONG_MAX
+#define INT64_MIN LONG_MIN /* !!!! PFCD */
+#define INT64_MAX LONG_MAX /* !!!! PFCD */
+#define UINT64_MAX ULONG_MAX /* !!!! PFCD */
+
+#define INTPTR_MIN INT32_MIN
+#define INTPTR_MAX INT32_MAX
+#define UINTPTR_MAX UINT32_MAX
+#define INTMAX_MIN INT64_MIN
+#define INTMAX_MIN INT64_MIN
+#define INT_LEAST16_MAX INT16_MAX
+#define INT_LEAST16_MAX INT16_MAX
+
+#elif defined(__VIDEOCORE__)
+
+typedef signed char int8_t;
+typedef unsigned char uint8_t;
+
+typedef signed short int16_t;
+typedef unsigned short uint16_t;
+
+typedef signed long int32_t;
+typedef unsigned long uint32_t;
+
+typedef signed long long int64_t;
+typedef unsigned long long uint64_t;
+
+typedef int32_t intptr_t;
+typedef uint32_t uintptr_t;
+typedef int64_t intmax_t;
+typedef uint64_t uintmax_t;
+typedef int16_t int_least16_t;
+
+#define INT8_MIN SCHAR_MIN
+#define INT8_MAX SCHAR_MAX
+#define UINT8_MAX UCHAR_MAX
+#define INT16_MIN SHRT_MIN
+#define INT16_MAX SHRT_MAX
+#define UINT16_MAX USHRT_MAX
+#define INT32_MIN LONG_MIN
+#define INT32_MAX LONG_MAX
+#define UINT32_MAX ULONG_MAX
+#define INT64_MIN LLONG_MIN
+#define INT64_MAX LLONG_MAX
+#define UINT64_MAX ULLONG_MAX
+
+#define INTPTR_MIN INT32_MIN
+#define INTPTR_MAX INT32_MAX
+#define UINTPTR_MAX UINT32_MAX
+#define INTMAX_MIN INT64_MIN
+#define INTMAX_MAX INT64_MAX
+#define INT_LEAST16_MAX INT16_MAX
+#define INT_LEAST16_MAX INT16_MAX
+
+#elif defined (__HIGHC__) && defined(_I386)
+
+#include <stdint.h>
+
+#else
+#error Unknown platform
+#endif
+
+#ifdef __cplusplus
+}
+#endif
+#endif /* VCOS_STDINT_H */
+
+
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_string.h
@@ -0,0 +1,73 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_STRING_H
+#define VCOS_STRING_H
+
+/**
+ * \file
+ *
+ * String functions.
+ *
+ */
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+#ifdef __KERNEL__
+#include <linux/string.h>
+#else
+#include <string.h>
+#endif
+
+/** Case insensitive string comparison.
+ *
+ */
+
+VCOS_INLINE_DECL
+int vcos_strcasecmp(const char *s1, const char *s2);
+
+VCOS_INLINE_DECL
+int vcos_strncasecmp(const char *s1, const char *s2, size_t n);
+
+VCOSPRE_ int VCOSPOST_ vcos_vsnprintf( char *buf, size_t buflen, const char *fmt, va_list ap );
+
+VCOSPRE_ int VCOSPOST_ vcos_snprintf(char *buf, size_t buflen, const char *fmt, ...);
+
+VCOS_STATIC_INLINE
+int vcos_strlen(const char *s) { return (int)strlen(s); }
+
+VCOS_STATIC_INLINE
+int vcos_strcmp(const char *s1, const char *s2) { return strcmp(s1,s2); }
+
+VCOS_STATIC_INLINE
+int vcos_strncmp(const char *cs, const char *ct, size_t count) { return strncmp(cs, ct, count); }
+
+VCOS_STATIC_INLINE
+char *vcos_strcpy(char *dst, const char *src) { return strcpy(dst, src); }
+
+VCOS_STATIC_INLINE
+char *vcos_strncpy(char *dst, const char *src, size_t count) { return strncpy(dst, src, count); }
+
+VCOS_STATIC_INLINE
+void *vcos_memcpy(void *dst, const void *src, size_t n) { memcpy(dst, src, n); return dst; }
+
+VCOS_STATIC_INLINE
+void *vcos_memset(void *p, int c, size_t n) { return memset(p, c, n); }
+
+#ifdef __cplusplus
+}
+#endif
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_thread.h
@@ -0,0 +1,259 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - public header file
+=============================================================================*/
+
+#ifndef VCOS_THREAD_H
+#define VCOS_THREAD_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/**
+ * \file vcos_thread.h
+ *
+ * \section thread Threads
+ *
+ * Under Nucleus, a thread is created by NU_Create_Task, passing in the stack
+ * and various other parameters. To stop the thread, NU_Terminate_Thread() and
+ * NU_Delete_Thread() are called.
+ *
+ * Unfortunately it's not possible to emulate this API under some fairly common
+ * operating systems. Under Windows you can't pass in the stack, and you can't
+ * safely terminate a thread.
+ *
+ * Therefore, an API which is similar to the pthreads API is used instead. This
+ * API can (mostly) be emulated under all interesting operating systems.
+ *
+ * Obviously this makes the code somewhat more complicated on VideoCore than it
+ * would otherwise be - we end up with an extra mutex per thread, and some code
+ * that waits for it. The benefit is that we have a single way of creating
+ * threads that works consistently on all platforms (apart from stack supplying).
+ *
+ * \subsection stack Stack
+ *
+ * It's still not possible to pass in the stack address, but this can be made
+ * much more obvious in the API: the relevant function is missing and the
+ * CPP symbol VCOS_CAN_SET_STACK_ADDR is zero rather than one.
+ *
+ * \subsection thr_create Creating a thread
+ *
+ * The simplest way to create a thread is with vcos_thread_create() passing in a
+ * NULL thread parameter argument. To wait for the thread to exit, call
+ * vcos_thread_join().
+ *
+ * \subsection back Backward compatibility
+ *
+ * To ease migration, a "classic" thread creation API is provided for code
+ * that used to make use of Nucleus, vcos_thread_create_classic(). The
+ * arguments are not exactly the same, as the PREEMPT parameter is dropped.
+ *
+ */
+
+#define VCOS_AFFINITY_CPU0 _VCOS_AFFINITY_CPU0
+#define VCOS_AFFINITY_CPU1 _VCOS_AFFINITY_CPU1
+#define VCOS_AFFINITY_MASK _VCOS_AFFINITY_MASK
+#define VCOS_AFFINITY_DEFAULT _VCOS_AFFINITY_DEFAULT
+#define VCOS_AFFINITY_THISCPU _VCOS_AFFINITY_THISCPU
+
+/** Report whether or not we have an RTOS at all, and hence the ability to
+ * create threads.
+ */
+VCOSPRE_ int VCOSPOST_ vcos_have_rtos(void);
+
+/** Create a thread. It must be cleaned up by calling vcos_thread_join().
+ *
+ * @param thread Filled in on return with thread
+ * @param name A name for the thread. May be the empty string.
+ * @param attrs Attributes; default attributes will be used if this is NULL.
+ * @param entry Entry point.
+ * @param arg Argument passed to the entry point.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_thread_create(VCOS_THREAD_T *thread,
+ const char *name,
+ VCOS_THREAD_ATTR_T *attrs,
+ VCOS_THREAD_ENTRY_FN_T entry,
+ void *arg);
+
+/** Exit the thread from within the thread function itself.
+ * Resources must still be cleaned up via a call to thread_join().
+ *
+ * The thread can also be terminated by simply exiting the thread function.
+ *
+ * @param data Data passed to thread_join. May be NULL.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_thread_exit(void *data);
+
+/** Wait for a thread to terminate and then clean up its resources.
+ *
+ * @param thread Thread to wait for
+ * @param pData Updated to point at data provided in vcos_thread_exit or exit
+ * code of thread function.
+ */
+VCOSPRE_ void VCOSPOST_ vcos_thread_join(VCOS_THREAD_T *thread,
+ void **pData);
+
+
+/**
+ * \brief Create a thread using an API similar to the one "traditionally"
+ * used under Nucleus.
+ *
+ * This creates a thread which must be cleaned up by calling vcos_thread_join().
+ * The thread cannot be simply terminated (as in Nucleus and ThreadX) as thread
+ * termination is not universally supported.
+ *
+ * @param thread Filled in with thread instance
+ * @param name An optional name for the thread. NULL or "" may be used (but
+ * a name will aid in debugging).
+ * @param entry Entry point
+ * @param arg A single argument passed to the entry point function
+ * @param stack Pointer to stack address
+ * @param stacksz Size of stack in bytes
+ * @param priaff Priority of task, between VCOS_PRI_LOW and VCOS_PRI_HIGH, ORed with the CPU affinity
+ * @param autostart If non-zero the thread will start immediately.
+ * @param timeslice Timeslice (system ticks) for this thread.
+ *
+ * @sa vcos_thread_terminate vcos_thread_delete
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_thread_create_classic(VCOS_THREAD_T *thread,
+ const char *name,
+ void *(*entry)(void *arg),
+ void *arg,
+ void *stack,
+ VCOS_UNSIGNED stacksz,
+ VCOS_UNSIGNED priaff,
+ VCOS_UNSIGNED timeslice,
+ VCOS_UNSIGNED autostart);
+
+/**
+ * \brief Set a thread's priority
+ *
+ * Set the priority for a thread.
+ *
+ * @param thread The thread
+ * @param pri Thread priority in VCOS_PRI_MASK bits; affinity in VCOS_AFFINITY_MASK bits.
+ */
+VCOS_INLINE_DECL
+void vcos_thread_set_priority(VCOS_THREAD_T *thread, VCOS_UNSIGNED pri);
+
+/**
+ * \brief Return the currently executing thread.
+ *
+ */
+VCOS_INLINE_DECL
+VCOS_THREAD_T *vcos_thread_current(void);
+
+/**
+ * \brief Return the thread's priority.
+ */
+VCOS_INLINE_DECL
+VCOS_UNSIGNED vcos_thread_get_priority(VCOS_THREAD_T *thread);
+
+/**
+ * \brief Return the thread's cpu affinity.
+ */
+VCOS_INLINE_DECL
+VCOS_UNSIGNED vcos_thread_get_affinity(VCOS_THREAD_T *thread);
+
+/**
+ * \brief Set the thread's cpu affinity.
+ */
+
+VCOS_INLINE_DECL
+void vcos_thread_set_affinity(VCOS_THREAD_T *thread, VCOS_UNSIGNED affinity);
+
+/**
+ * \brief Query whether we are in an interrupt.
+ *
+ * @return 1 if in interrupt context.
+ */
+VCOS_INLINE_DECL
+int vcos_in_interrupt(void);
+
+/**
+ * \brief Sleep a while.
+ *
+ * @param ms Number of milliseconds to sleep for
+ *
+ * This may actually sleep a whole number of ticks.
+ */
+VCOS_INLINE_DECL
+void vcos_sleep(uint32_t ms);
+
+/**
+ * \brief Return the value of the hardware microsecond counter.
+ *
+ */
+VCOS_INLINE_DECL
+uint32_t vcos_getmicrosecs(void);
+
+#define vcos_get_ms() (vcos_getmicrosecs()/1000)
+
+/**
+ * \brief Return a unique identifier for the current process
+ *
+ */
+VCOS_INLINE_DECL
+VCOS_UNSIGNED vcos_process_id_current(void);
+
+/** Relinquish this time slice. */
+VCOS_INLINE_DECL
+void vcos_thread_relinquish(void);
+
+/** Return the name of the given thread.
+ */
+VCOSPRE_ const char * VCOSPOST_ vcos_thread_get_name(const VCOS_THREAD_T *thread);
+
+/** Change preemption. This is almost certainly not what you want, as it won't
+ * work reliably in a multicore system: although you can affect the preemption
+ * on *this* core, you won't affect what's happening on the other core(s).
+ *
+ * It's mainly here to ease migration. If you're using it in new code, you
+ * probably need to think again.
+ *
+ * @param pe New preemption, VCOS_PREEMPT or VCOS_NO_PREEMPT
+ * @return Old value of preemption.
+ */
+VCOS_INLINE_DECL
+VCOS_UNSIGNED vcos_change_preemption(VCOS_UNSIGNED pe);
+
+/** Is a thread still running, or has it exited?
+ *
+ * Note: this exists for some fairly scary code in the video codec tests. Don't
+ * try to use it for anything else, as it may well not do what you expect.
+ *
+ * @param thread thread to query
+ * @return non-zero if thread is running, or zero if it has exited.
+ */
+VCOS_INLINE_DECL
+int vcos_thread_running(VCOS_THREAD_T *thread);
+
+/** Resume a thread.
+ *
+ * @param thread thread to resume
+ */
+VCOS_INLINE_DECL
+void vcos_thread_resume(VCOS_THREAD_T *thread);
+
+/*
+ * Internal APIs - may not always be present and should not be used in
+ * client code.
+ */
+
+extern void _vcos_task_timer_set(void (*pfn)(void*), void *, VCOS_UNSIGNED ms);
+extern void _vcos_task_timer_cancel(void);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_thread_attr.h
@@ -0,0 +1,73 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - thread attributes
+=============================================================================*/
+
+#ifndef VCOS_THREAD_ATTR_H
+#define VCOS_THREAD_ATTR_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/**
+ * \file
+ *
+ * Attributes for thread creation.
+ *
+ */
+
+/** Initialize thread attribute struct. This call does not allocate memory,
+ * and so cannot fail.
+ *
+ */
+VCOSPRE_ void VCOSPOST_ vcos_thread_attr_init(VCOS_THREAD_ATTR_T *attrs);
+
+/** Set the stack address and size. If not set, a stack will be allocated automatically.
+ *
+ * This can only be set on some platforms. It will always be possible to set the stack
+ * address on VideoCore, but on host platforms, support may well not be available.
+ */
+#if VCOS_CAN_SET_STACK_ADDR
+VCOS_INLINE_DECL
+void vcos_thread_attr_setstack(VCOS_THREAD_ATTR_T *attrs, void *addr, VCOS_UNSIGNED sz);
+#endif
+
+/** Set the stack size. If not set, a default size will be used. Attempting to call this after having
+ * set the stack location with vcos_thread_attr_setstack() will result in undefined behaviour.
+ */
+VCOS_INLINE_DECL
+void vcos_thread_attr_setstacksize(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED sz);
+
+/** Set the task priority. If not set, a default value will be used.
+ */
+VCOS_INLINE_DECL
+void vcos_thread_attr_setpriority(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED pri);
+
+/** Set the task cpu affinity. If not set, the default will be used.
+ */
+VCOS_INLINE_DECL
+void vcos_thread_attr_setaffinity(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED aff);
+
+/** Set the timeslice. If not set the default will be used.
+ */
+VCOS_INLINE_DECL
+void vcos_thread_attr_settimeslice(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED ts);
+
+/** The thread entry function takes (argc,argv), as per Nucleus, with
+ * argc being 0. This may be withdrawn in a future release and should not
+ * be used in new code.
+ */
+VCOS_INLINE_DECL
+void _vcos_thread_attr_setlegacyapi(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED legacy);
+
+VCOS_INLINE_DECL
+void vcos_thread_attr_setautostart(VCOS_THREAD_ATTR_T *attrs, VCOS_UNSIGNED autostart);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_timer.h
@@ -0,0 +1,95 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+Project : vcfw
+Module : chip driver
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - timer support
+=============================================================================*/
+
+#ifndef VCOS_TIMER_H
+#define VCOS_TIMER_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "interface/vcos/vcos_types.h"
+#include "vcos_platform.h"
+
+/** \file vcos_timer.h
+ *
+ * Timers are single shot.
+ *
+ * Timer times are in milliseconds.
+ *
+ * \note that timer callback functions are called from an arbitrary thread
+ * context. The expiration function should do its work as quickly as possible;
+ * blocking should be avoided.
+ *
+ * \note On Windows, the separate function vcos_timer_init() must be called
+ * as timer initialization from DllMain is not possible.
+ */
+
+/** Perform timer subsystem initialization. This function is not needed
+ * on non-Windows platforms but is still present so that it can be
+ * called. On Windows it is needed because vcos_init() gets called
+ * from DLL initialization where it is not possible to create a
+ * time queue (deadlock occurs if you try).
+ *
+ * @return VCOS_SUCCESS on success. VCOS_EEXIST if this has already been called
+ * once. VCOS_ENOMEM if resource allocation failed.
+ */
+VCOSPRE_ VCOS_STATUS_T VCOSPOST_ vcos_timer_init(void);
+
+/** Create a timer in a disabled state.
+ *
+ * The timer is initially disabled.
+ *
+ * @param timer timer handle
+ * @param name name for timer
+ * @param expiration_routine function to call when timer expires
+ * @param context context passed to expiration routine
+ *
+ */
+VCOS_INLINE_DECL
+VCOS_STATUS_T vcos_timer_create(VCOS_TIMER_T *timer,
+ const char *name,
+ void (*expiration_routine)(void *context),
+ void *context);
+
+
+
+/** Start a timer running.
+ *
+ * Timer must be stopped.
+ *
+ * @param timer timer handle
+ * @param delay Delay to wait for, in ms
+ */
+VCOS_INLINE_DECL
+void vcos_timer_set(VCOS_TIMER_T *timer, VCOS_UNSIGNED delay);
+
+/** Stop an already running timer.
+ *
+ * @param timer timer handle
+ */
+VCOS_INLINE_DECL
+void vcos_timer_cancel(VCOS_TIMER_T *timer);
+
+/** Stop a timer and restart it.
+ * @param timer timer handle
+ * @param delay delay in ms
+ */
+VCOS_INLINE_DECL
+void vcos_timer_reset(VCOS_TIMER_T *timer, VCOS_UNSIGNED delay);
+
+VCOS_INLINE_DECL
+void vcos_timer_delete(VCOS_TIMER_T *timer);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
--- /dev/null
+++ b/drivers/misc/vc04_services/interface/vcos/vcos_types.h
@@ -0,0 +1,197 @@
+/*=============================================================================
+Copyright (c) 2009 Broadcom Europe Limited.
+All rights reserved.
+
+FILE DESCRIPTION
+VideoCore OS Abstraction Layer - basic types
+=============================================================================*/
+
+#ifndef VCOS_TYPES_H
+#define VCOS_TYPES_H
+
+#define VCOS_VERSION 1
+
+#include "vcos_platform_types.h"
+
+#if !defined(VCOSPRE_) || !defined(VCOSPOST_)
+#error VCOSPRE_ and VCOSPOST_ not defined!
+#endif
+
+/* Redefine these here; this means that existing header files can carry on
+ * using the VCHPOST/VCHPRE macros rather than having huge changes, which
+ * could cause nasty merge problems.
+ */
+#ifndef VCHPOST_
+#define VCHPOST_ VCOSPOST_
+#endif
+#ifndef VCHPRE_
+#define VCHPRE_ VCOSPRE_
+#endif
+
+/** Entry function for a lowlevel thread.
+ *
+ * Returns void for consistency with Nucleus/ThreadX.
+ */
+typedef void (*VCOS_LLTHREAD_ENTRY_FN_T)(void *);
+
+/** Thread entry point. Returns a void* for consistency
+ * with pthreads.
+ */
+typedef void *(*VCOS_THREAD_ENTRY_FN_T)(void*);
+
+
+/* Error return codes - chosen to be similar to errno values */
+typedef enum
+{
+ VCOS_SUCCESS,
+ VCOS_EAGAIN,
+ VCOS_ENOENT,
+ VCOS_ENOSPC,
+ VCOS_EINVAL,
+ VCOS_EACCESS,
+ VCOS_ENOMEM,
+ VCOS_ENOSYS,
+ VCOS_EEXIST,
+ VCOS_ENXIO,
+ VCOS_EINTR
+} VCOS_STATUS_T;
+
+/* Some compilers (MetaWare) won't inline with -g turned on, which then results
+ * in a lot of code bloat. To overcome this, inline functions are forward declared
+ * with the prefix VCOS_INLINE_DECL, and implemented with the prefix VCOS_INLINE_IMPL.
+ *
+ * That then means that in a release build, "static inline" can be used in the obvious
+ * way, but in a debug build the implementations can be skipped in all but one file,
+ * by using VCOS_INLINE_BODIES.
+ *
+ * VCOS_INLINE_DECL - put this at the start of an inline forward declaration of a VCOS
+ * function.
+ *
+ * VCOS_INLINE_IMPL - put this at the start of an inlined implementation of a VCOS
+ * function.
+ *
+ */
+
+/* VCOS_EXPORT - it turns out that in some circumstances we need the implementation of
+ * a function even if it is usually inlined.
+ *
+ * In particular, if we have a codec that is usually provided in object form, if it
+ * was built for a debug build it will be full of calls to vcos_XXX(). If this is used
+ * in a *release* build, then there won't be any of these calls around in the main image
+ * as they will all have been inlined. The problem also exists for vcos functions called
+ * from assembler.
+ *
+ * VCOS_EXPORT ensures that the named function will be emitted as a regular (not static-inline)
+ * function inside vcos_<platform>.c so that it can be linked against. Doing this for every
+ * VCOS function would be a bit code-bloat-tastic, so it is only done for those that need it.
+ *
+ */
+
+#ifdef __cplusplus
+#define _VCOS_INLINE inline
+#else
+#define _VCOS_INLINE __inline
+#endif
+
+#if defined(NDEBUG)
+
+#ifdef __GNUC__
+# define VCOS_INLINE_DECL extern __inline__
+# define VCOS_INLINE_IMPL static __inline__
+#else
+# define VCOS_INLINE_DECL static _VCOS_INLINE /* declare a func */
+# define VCOS_INLINE_IMPL static _VCOS_INLINE /* implement a func inline */
+#endif
+
+# if defined(VCOS_WANT_IMPL)
+# define VCOS_EXPORT
+# else
+# define VCOS_EXPORT VCOS_INLINE_IMPL
+# endif /* VCOS_WANT_IMPL */
+
+#define VCOS_INLINE_BODIES
+
+#else /* NDEBUG */
+
+#if !defined(VCOS_INLINE_DECL)
+ #define VCOS_INLINE_DECL extern
+#endif
+#if !defined(VCOS_INLINE_IMPL)
+ #define VCOS_INLINE_IMPL
+#endif
+#define VCOS_EXPORT VCOS_INLINE_IMPL
+#endif
+
+#define VCOS_STATIC_INLINE static _VCOS_INLINE
+
+#if defined(__HIGHC__) || defined(__HIGHC_ANSI__)
+#define _VCOS_METAWARE
+#endif
+
+/** It seems that __FUNCTION__ isn't standard!
+ */
+#if __STDC_VERSION__ < 199901L
+# if __GNUC__ >= 2 || defined(__VIDEOCORE__)
+# define VCOS_FUNCTION __FUNCTION__
+# else
+# define VCOS_FUNCTION "<unknown>"
+# endif
+#else
+# define VCOS_FUNCTION __func__
+#endif
+
+#define _VCOS_MS_PER_TICK (1000/VCOS_TICKS_PER_SECOND)
+
+/* Convert a number of milliseconds to a tick count. Internal use only - fails to
+ * convert VCOS_SUSPEND correctly.
+ */
+#define _VCOS_MS_TO_TICKS(ms) (((ms)+_VCOS_MS_PER_TICK-1)/_VCOS_MS_PER_TICK)
+
+#define VCOS_TICKS_TO_MS(ticks) ((ticks) * _VCOS_MS_PER_TICK)
+
+/** VCOS version of DATESTR, from pcdisk.h. Used by the hostreq service.
+ */
+typedef struct vcos_datestr
+{
+ uint8_t cmsec; /**< Centesimal mili second */
+ uint16_t date; /**< Date */
+ uint16_t time; /**< Time */
+
+} VCOS_DATESTR;
+
+/* Compile-time assert - declares invalid array length if condition
+ * not met, or array of length one if OK.
+ */
+#define VCOS_CASSERT(e) extern char vcos_compile_time_check[1/(e)]
+
+#define vcos_min(x,y) ((x) < (y) ? (x) : (y))
+#define vcos_max(x,y) ((x) > (y) ? (x) : (y))
+
+/** Return the count of an array. FIXME: under gcc we could make
+ * this report an error for pointers using __builtin_types_compatible().
+ */
+#define vcos_countof(x) (sizeof((x)) / sizeof((x)[0]))
+
+/* for backward compatibility */
+#define countof(x) (sizeof((x)) / sizeof((x)[0]))
+
+#define VCOS_ALIGN_DOWN(p,n) (((ptrdiff_t)(p)) & ~((n)-1))
+#define VCOS_ALIGN_UP(p,n) VCOS_ALIGN_DOWN((ptrdiff_t)(p)+(n)-1,(n))
+
+/** bool_t is not a POSIX type so cannot rely on it. Define it here.
+ * It's not even defined in stdbool.h.
+ */
+typedef int32_t vcos_bool_t;
+typedef int32_t vcos_fourcc_t;
+
+#define VCOS_FALSE 0
+#define VCOS_TRUE (!VCOS_FALSE)
+
+/** Mark unused arguments to keep compilers quiet */
+#define vcos_unused(x) (void)(x)
+
+/** For backward compatibility */
+typedef vcos_fourcc_t fourcc_t;
+typedef vcos_fourcc_t FOURCC_T;
+
+#endif