summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c
diff options
context:
space:
mode:
authorJoel Sherrill <joel.sherrill@OARcorp.com>2011-08-01 13:48:40 +0000
committerJoel Sherrill <joel.sherrill@OARcorp.com>2011-08-01 13:48:40 +0000
commitdce1032b6cdc2cd3c4e6b0ca3695aca6558c56c3 (patch)
treee485d78b238db7255395470e037305af8b8a642c /c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c
parent2011-08-01 Jennifer Averett <Jennifer.Averett@OARcorp.com> (diff)
downloadrtems-dce1032b6cdc2cd3c4e6b0ca3695aca6558c56c3.tar.bz2
2011-08-01 Sebastien Bourdeauducq <sebastien.bourdeauducq@gmail.com>
PR 1869/bsps * startup/bspclean.c: New file. * include/tm27.h: Removed. * ChangeLog, Makefile.am, README, preinstall.am, include/bsp.h, include/system_conf.h, make/custom/milkymist.cfg, startup/linkcmds: Complete BSP for Milkymist One supporting Milkymist SOC 1.0.x. Includes new or updated drivers for: - Multi-standard video input (PAL/SECAM/NTSC) - Two DMX512 (RS485) ports - MIDI IN and MIDI OUT ports - VGA output - AC'97 audio - NOR flash - 10/100 Ethernet - Memory card (experimental and incomplete) - USB host connectors (input devices only) - RC5 infrared receiver - RS232 debug port
Diffstat (limited to 'c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c')
-rw-r--r--c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c130
1 files changed, 130 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c b/c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c
new file mode 100644
index 0000000000..a51d17da1c
--- /dev/null
+++ b/c/src/lib/libbsp/lm32/shared/milkymist_dmx/dmx.c
@@ -0,0 +1,130 @@
+/* dmx.c
+ *
+ * Milkymist DMX512 driver for RTEMS
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ *
+ * $Id$
+ *
+ * COPYRIGHT (c) 2010, 2011 Sebastien Bourdeauducq
+ */
+
+#define RTEMS_STATUS_CHECKS_USE_PRINTK
+
+#include <stdlib.h>
+#include <sys/types.h>
+#include <rtems.h>
+#include <rtems/status-checks.h>
+#include <bsp.h>
+#include <rtems/libio.h>
+#include "../include/system_conf.h"
+#include "milkymist_dmx.h"
+
+#define IN_DEVICE_NAME "/dev/dmx_in"
+#define OUT_DEVICE_NAME "/dev/dmx_out"
+
+rtems_device_driver dmx_initialize(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
+{
+ rtems_status_code sc;
+
+ sc = rtems_io_register_name(IN_DEVICE_NAME, major, 0);
+ RTEMS_CHECK_SC(sc, "create DMX input device");
+
+ sc = rtems_io_register_name(OUT_DEVICE_NAME, major, 1);
+ RTEMS_CHECK_SC(sc, "create DMX output device");
+
+ return RTEMS_SUCCESSFUL;
+}
+
+rtems_device_driver dmx_read(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
+{
+ rtems_libio_rw_args_t *rw_args = (rtems_libio_rw_args_t *)arg;
+ int len;
+ unsigned int i;
+ unsigned char *values = (unsigned char *)rw_args->buffer;
+
+ len = 512 - rw_args->offset;
+ if (len < 0) {
+ rw_args->bytes_moved = 0;
+ return RTEMS_SUCCESSFUL;
+ }
+ if (len > rw_args->count)
+ len = rw_args->count;
+
+ if (minor == 0) {
+ for (i=0;i<len;i++)
+ values[i] = MM_READ(MM_DMX_RX((unsigned int)rw_args->offset+i));
+ } else {
+ for (i=0;i<len;i++)
+ values[i] = MM_READ(MM_DMX_TX((unsigned int)rw_args->offset+i));
+ }
+
+ rw_args->bytes_moved = len;
+
+ return RTEMS_SUCCESSFUL;
+}
+
+rtems_device_driver dmx_write(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
+{
+ rtems_libio_rw_args_t *rw_args = (rtems_libio_rw_args_t *)arg;
+ int len;
+ unsigned int i;
+ unsigned char *values = (unsigned char *)rw_args->buffer;
+
+ if (minor == 0) {
+ rw_args->bytes_moved = 0;
+ return RTEMS_UNSATISFIED;
+ }
+
+ len = 512 - rw_args->offset;
+ if (len < 0) {
+ rw_args->bytes_moved = 0;
+ return RTEMS_SUCCESSFUL;
+ }
+ if (len > rw_args->count)
+ len = rw_args->count;
+
+ for (i=0;i<len;i++)
+ MM_WRITE(MM_DMX_TX((unsigned int)rw_args->offset+i), values[i]);
+
+ rw_args->bytes_moved = len;
+
+ return RTEMS_SUCCESSFUL;
+}
+
+rtems_device_driver dmx_control(
+ rtems_device_major_number major,
+ rtems_device_minor_number minor,
+ void *arg
+)
+{
+ rtems_libio_ioctl_args_t *args = arg;
+
+ switch (args->command) {
+ case DMX_SET_THRU:
+ args->ioctl_return = 0;
+ MM_WRITE(MM_DMX_THRU, (unsigned int)args->buffer);
+ return RTEMS_SUCCESSFUL;
+ case DMX_GET_THRU:
+ args->ioctl_return = 0;
+ *((unsigned int *)args->buffer) = MM_READ(MM_DMX_THRU);
+ return RTEMS_SUCCESSFUL;
+ default:
+ args->ioctl_return = -1;
+ return RTEMS_UNSATISFIED;
+ }
+}