Din16需要修改滤波方案

src/main/scala/backBoard/LocalRegisters.scala

@@ -3,8 +3,169 @@ package BACK
 import chisel3._
 import chisel3.util._
 
+class ManualParamBundle extends Bundle{
+  val vendorID = UInt( 16.W )
+  val moduleID = UInt( 16.W )
+  val hwVersion = UInt( 16.W )
+  val swVersion = UInt( 16.W )
+  val batchID  = UInt( 16.W )
+  val serial   = UInt( 48.W )
+}
 
-class BackBoardSlvDigitalIO extends BackBoardSlvBase with BackBoardSlvDown with BackBoardSlvUp{
+
+abstract class BackBoardSlvLocal extends BackBoardSlvBase with BackBoardSlvDown with BackBoardSlvUp{
+
+  def DATA_SINWR_ADDR   : UInt = "h00".U
+  def DATA_PERWR_ADDR   : UInt = "h02".U
+  def STATUSWR_ADDR     : UInt = "h04".U
+
+  def DATA_SINRD_ADDR   : UInt = "h00".U
+  def DATA_PERRD_ADDR   : UInt = "h02".U
+  def STATUSRD_ADDR     : UInt = "h04".U
+
+  def VENDORID_ADDR     : UInt = "h10".U
+  def MODULEID_ADDR     : UInt = "h12".U
+  def HVERSION_ADDR     : UInt = "h14".U
+  def SVERSION_ADDR     : UInt = "h16".U
+  def BATCHNUM_ADDR     : UInt = "h18".U
+  def SERIAL0_ADDR      : UInt = "h1a".U
+  def SERIAL1_ADDR      : UInt = "h1c".U
+  def SERIAL2_ADDR      : UInt = "h1e".U
+
+  val param = IO(Input( new ManualParamBundle ))
+
+  val rankNum    = downReg(4)
+  val statusLed  = downReg(5)(1,0)
+
+  val (us10Counter, us10Trigger) = Counter(Range(0, 500))
+
+  when( true.B ){
+
+
+    upReg(16) := param.vendorID(7,0)
+    upReg(17) := param.vendorID(15,8)
+
+    upReg(18) := param.moduleID(7,0)
+    upReg(19) := param.moduleID(15,8)
+
+    upReg(20) := param.hwVersion(7,0)
+    upReg(21) := param.hwVersion(15,8)
+
+    upReg(22) := param.swVersion(7,0)
+    upReg(23) := param.swVersion(15,8)
+
+    upReg(24) := param.batchID(7,0)
+    upReg(25) := param.batchID(15,8)
+
+    upReg(26) := param.serial(7,0)
+    upReg(27) := param.serial(15,8)
+    upReg(28) := param.serial(23,16)
+    upReg(29) := param.serial(31,24)
+    upReg(30) := param.serial(39,32)
+    upReg(31) := param.serial(47,40)    
+  }
+
+
+}
+
+trait BackBoardSlvStatusLed { this: BackBoardSlvLocal =>
+  val flashCounter = RegInit( 0.U( 20.W ) )
+
+  when( us10Trigger ){
+    when( flashCounter === 100000.U ){
+      flashCounter := 0.U
+    } .otherwise{
+      flashCounter := flashCounter + 1.U      
+    }
+  }
+
+  val flash1HZ = flashCounter.extract(19)
+  val flash2HZ = flashCounter.extract(18)
+
+  val LED_PR = IO(Output( Bool() ))
+
+  LED_PR := Mux1H(Seq(
+    ( statusLed === "b00".U ) -> flash2HZ,
+    ( statusLed === "b01".U ) -> flash1HZ, 
+    ( statusLed === "b10".U ) -> true.B,
+    ( statusLed === "b11".U ) -> false.B,
+    ))
+}
+
+
+
+trait BackBoardSlvIn { this: BackBoardSlvLocal =>
+
+  def gp: Int
+
+  val flitCfg = Seq(
+    ( 0.U  -> 0.S ),
+    ( 1.U  -> 10.S),
+    ( 2.U  -> 25.S),
+    ( 3.U  -> 50.S),
+    ( 4.U  -> 100.S),
+    ( 5.U  -> 200.S),
+    ( 6.U  -> 400.S),
+    ( 7.U  -> 800.S),
+    ( 8.U  -> 1600.S),
+    ( 9.U  -> 3200.S),
+    ( 10.U -> 6400.S),
+  )
+
+  val in = IO(Input(UInt((8*gp).W)))
+
+  val digitalIn = Reg( Vec( 8*gp, Bool() ) )
+  
+
+  for( j <- 0 until gp ) {
+    when( true.B ) { upReg( 2+j ) := Cat( ( 8*j+7 to 8*j ).map{ k => digitalIn(k) } ) }
+
+    val digitalFilter = downReg(0+j)
+
+    for( i <- 0 until 8 ) {
+      val toCnt = RegInit( 0.S( 16.W ) )
+
+      flitCfg.map{ ( cfg: (UInt,SInt) ) => 
+        when( digitalFilter === cfg._1 ){
+          when( in(i+8*j) ){
+            when( toCnt >= cfg._2 ){
+              toCnt := cfg._2
+              digitalIn(i+8*j) := true.B
+            } .otherwise{
+              toCnt := toCnt + 1.S
+            }
+          } .otherwise{
+            when( toCnt <= -cfg._2 ){
+              toCnt := -cfg._2
+              digitalIn(i+8*j) := false.B
+            } .otherwise{
+              toCnt := toCnt - 1.S
+            }
+          }
+        }        
+        
+      }
+    }
+  }
+
+}
+
+
+
+
+class DIn16 extends BackBoardSlvLocal
+with BackBoardSlvStatusLed
+with BackBoardSlvIn{
+  def gp = 2
+}
+
+
+
+
+
+
+
+class BackBoardSlvOut16 extends BackBoardSlvLocal{
   val in  = IO(Input(UInt(32.W)))
   val out = IO(Output(UInt(32.W)))
   val oe  = IO(Output(UInt(32.W)))
@@ -14,18 +175,12 @@ class BackBoardSlvDigitalIO extends BackBoardSlvBase with BackBoardSlvDown with
   out := Cat( (0 until 4).map{i => downReg(i)}.reverse )
   oe  := Cat( (4 until 8).map{i => downReg(i)}.reverse )
 
-
   for( i <- 0 until 4 ) {
     upReg(i) := in( i*8+7,8*i )
   }
-
-
 }
 
 
-
-
-
 // trait LocalRegisters { this: BackBoardSlvBase =>
 //   val led = IO(Output(UInt(3.W)))
 //   val sw  = IO( Input(UInt(1.W)))