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

1 files changed, 163 insertions, 0 deletions

diff --git a/c/src/lib/libbsp/lm32/shared/milkymist_tmu/tmu.c b/c/src/lib/libbsp/lm32/shared/milkymist_tmu/tmu.c
new file mode 100644
index 0000000000..b057fc9582
--- /dev/null
+++ b/c/src/lib/libbsp/lm32/shared/milkymist_tmu/tmu.c
@@ -0,0 +1,163 @@
+/*  tmu.c
+ *
+ *  Milkymist TMU 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 <stdio.h>
+#include <errno.h>
+#include <sys/types.h>
+#include <rtems.h>
+#include <bsp.h>
+#include <bsp/irq-generic.h>
+#include <rtems/libio.h>
+#include <rtems/status-checks.h>
+#include "../include/system_conf.h"
+#include "milkymist_tmu.h"
+
+#define DEVICE_NAME "/dev/tmu"
+
+static rtems_id done_sem;
+
+static rtems_isr done_handler(rtems_vector_number n)
+{
+  rtems_semaphore_release(done_sem);
+  lm32_interrupt_ack(1 << MM_IRQ_TMU);
+}
+
+rtems_device_driver tmu_initialize(
+  rtems_device_major_number major,
+  rtems_device_minor_number minor,
+  void *arg
+)
+{
+  rtems_status_code sc;
+  rtems_isr_entry dummy;
+
+  sc = rtems_io_register_name(DEVICE_NAME, major, 0);
+  RTEMS_CHECK_SC(sc, "create TMU device");
+
+  sc = rtems_semaphore_create(
+    rtems_build_name('T', 'M', 'U', ' '),
+    0,
+    RTEMS_SIMPLE_BINARY_SEMAPHORE,
+    0,
+    &done_sem
+  );
+  RTEMS_CHECK_SC(sc, "create TMU done semaphore");
+
+  rtems_interrupt_catch(done_handler, MM_IRQ_TMU, &dummy);
+  bsp_interrupt_vector_enable(MM_IRQ_TMU);
+
+  return RTEMS_SUCCESSFUL;
+}
+
+static void invalidate_l2(void)
+{
+  volatile char *flushbase = (char *)FMLBRG_FLUSH_BASE;
+  int i, offset;
+
+  offset = 0;
+  for (i=0;i<FMLBRG_LINE_COUNT;i++) {
+    flushbase[offset] = 0;
+    offset += FMLBRG_LINE_LENGTH;
+  }
+}
+
+static bool invalidate_after;
+
+static void tmu_start(struct tmu_td *td)
+{
+  if (td->invalidate_before)
+    invalidate_l2();
+
+  MM_WRITE(MM_TMU_HMESHLAST, td->hmeshlast);
+  MM_WRITE(MM_TMU_VMESHLAST, td->vmeshlast);
+  MM_WRITE(MM_TMU_BRIGHTNESS, td->brightness);
+  MM_WRITE(MM_TMU_CHROMAKEY, td->chromakey);
+
+  MM_WRITE(MM_TMU_VERTICESADR, (unsigned int)td->vertices);
+  MM_WRITE(MM_TMU_TEXFBUF, (unsigned int)td->texfbuf);
+  MM_WRITE(MM_TMU_TEXHRES, td->texhres);
+  MM_WRITE(MM_TMU_TEXVRES, td->texvres);
+  MM_WRITE(MM_TMU_TEXHMASK, td->texhmask);
+  MM_WRITE(MM_TMU_TEXVMASK, td->texvmask);
+
+  MM_WRITE(MM_TMU_DSTFBUF, (unsigned int)td->dstfbuf);
+  MM_WRITE(MM_TMU_DSTHRES, td->dsthres);
+  MM_WRITE(MM_TMU_DSTVRES, td->dstvres);
+  MM_WRITE(MM_TMU_DSTHOFFSET, td->dsthoffset);
+  MM_WRITE(MM_TMU_DSTVOFFSET, td->dstvoffset);
+  MM_WRITE(MM_TMU_DSTSQUAREW, td->dstsquarew);
+  MM_WRITE(MM_TMU_DSTSQUAREH, td->dstsquareh);
+
+  MM_WRITE(MM_TMU_ALPHA, td->alpha);
+
+  MM_WRITE(MM_TMU_CTL, td->flags|TMU_CTL_START);
+
+  invalidate_after = td->invalidate_after;
+}
+
+static rtems_status_code tmu_finalize(void)
+{
+  rtems_status_code sc;
+
+  sc = rtems_semaphore_obtain(done_sem, RTEMS_WAIT, 100);
+  if (sc != RTEMS_SUCCESSFUL)
+    return sc;
+
+  if (invalidate_after) {
+    invalidate_l2();
+    __asm__ volatile( /* Invalidate Level-1 data cache */
+      "wcsr DCC, r0\n"
+      "nop\n"
+    );
+  }
+
+  return RTEMS_SUCCESSFUL;
+}
+
+rtems_device_driver tmu_control(
+  rtems_device_major_number major,
+  rtems_device_minor_number minor,
+  void *arg
+)
+{
+  rtems_libio_ioctl_args_t *args = arg;
+  struct tmu_td *td = (struct tmu_td *)args->buffer;
+  rtems_status_code sc;
+
+  switch (args->command) {
+    case TMU_EXECUTE:
+      tmu_start(td);
+      sc = tmu_finalize();
+      break;
+    case TMU_EXECUTE_NONBLOCK:
+      tmu_start(td);
+      sc = RTEMS_SUCCESSFUL;
+      break;
+    case TMU_EXECUTE_WAIT:
+      sc = tmu_finalize();
+      break;
+    default:
+      sc = RTEMS_UNSATISFIED;
+      break;
+  }
+
+  if (sc == RTEMS_SUCCESSFUL)
+    args->ioctl_return = 0;
+  else
+    args->ioctl_return = -1;
+
+  return sc;
+}