From 4259699d7819cc12e653ee23b56c5e851f470ccf Mon Sep 17 00:00:00 2001
From: Sebastien Bourdeauducq <sebastien@milkymist.org>
Date: Sat, 4 May 2013 20:40:21 +0200
Subject: [PATCH] dvisampler: add RawDVISampler

---
 milkymist/dvisampler/__init__.py | 38 ++++++++++++++++++++++++++++++++
 1 file changed, 38 insertions(+)

diff --git a/milkymist/dvisampler/__init__.py b/milkymist/dvisampler/__init__.py
index 6d54ac537..fcbcb165a 100644
--- a/milkymist/dvisampler/__init__.py
+++ b/milkymist/dvisampler/__init__.py
@@ -1,6 +1,8 @@
 from migen.fhdl.structure import *
 from migen.fhdl.module import Module
 from migen.bank.description import *
+from migen.genlib.fifo import AsyncFIFO
+from migen.actorlib import structuring, dma_asmi, spi
 
 from milkymist.dvisampler.edid import EDID
 from milkymist.dvisampler.clocking import Clocking
@@ -64,3 +66,39 @@ class DVISampler(Module, AutoCSR):
 			self.resdetection.hsync.eq(hsync),
 			self.resdetection.vsync.eq(vsync)
 		]
+
+class RawDVISampler(Module, AutoCSR):
+	def __init__(self, pads, asmiport):
+		self.submodules.edid = EDID(pads)
+		self.submodules.clocking = Clocking(pads)
+
+		invert = False
+		try:
+			s = getattr(pads, "data0")
+		except AttributeError:
+			s = getattr(pads, "data0_n")
+			invert = True
+		self.submodules.data0_cap = DataCapture(8, invert)
+		self.comb += [
+			self.data0_cap.pad.eq(s),
+			self.data0_cap.serdesstrobe.eq(self.clocking.serdesstrobe)
+		]
+
+		fifo = AsyncFIFO(10, 1024)
+		self.add_submodule(fifo, {"write": "pix", "read": "sys"})
+		self.comb += [
+			fifo.din.eq(self.data0_cap.d),
+			fifo.we.eq(1)
+		]
+
+		pack_factor = asmiport.hub.dw//16
+		self.submodules.packer = structuring.Pack([("word", 10), ("pad", 6)], pack_factor)
+		self.submodules.cast = structuring.Cast(self.packer.source.payload.layout, asmiport.hub.dw)
+		self.submodules.dma = spi.DMAWriteController(dma_asmi.Writer(asmiport), spi.MODE_SINGLE_SHOT)
+		self.comb += [
+			self.packer.sink.stb.eq(fifo.readable),
+			fifo.re.eq(self.packer.sink.ack),
+			self.packer.sink.payload.word.eq(fifo.dout),
+			self.packer.source.connect(self.cast.sink, match_by_position=True),
+			self.cast.source.connect(self.dma.data, match_by_position=True)
+		]