S5443Top.v 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234
  1. `timescale 1ns / 1ps
  2. //////////////////////////////////////////////////////////////////////////////////
  3. // company:
  4. // engineer:
  5. //
  6. // create date: 12:23:20 05/20/2019
  7. // design name:
  8. // module name: S5443Top
  9. // project name:
  10. // target devices:
  11. // tool versions:
  12. // description:
  13. //
  14. // dependencies:
  15. //
  16. // revision:
  17. // revision 0.01 - file created
  18. // additional comments:
  19. //
  20. //================================================================================
  21. //
  22. //Spi clock for ADC initialization is 15Mhz.
  23. //Spi clock for RegMap work is 41Mhz.
  24. //Нужно сделать процедуру сброса для импульсных измерений, такую же как для обычных, тоесть по детектированию спадающего фронта StartMeas;
  25. //Забрать из команды настройки измерения, биты управления ключем и замкнуть на выходы.
  26. //////////////////////////////////////////////////////////////////////////////////
  27. // xc7s25-2csga225
  28. module S5443Top
  29. #(
  30. parameter LpDataWidth = 16,
  31. parameter CtrlWidth = 4,
  32. parameter AdcDataWidth = 14,
  33. parameter ThresholdWidth = 24,
  34. parameter ResultWidth = 32,
  35. parameter ChNum = 4,
  36. parameter PGenNum = 7,
  37. parameter TrigPortsNum = 6,
  38. parameter Ratio = 8,
  39. parameter DelayValue = 24000,
  40. parameter LengthWidth = 2000,
  41. parameter DataWidth = 24,
  42. parameter DataNum = 26,
  43. parameter CmdRegWidth = 32,
  44. parameter HeaderWidth = 7,
  45. parameter CmdDataRegWith = 24,
  46. parameter DataCntWidth = 5,
  47. parameter Divparam = 4,
  48. parameter MeasPeriod = 44,
  49. parameter PhIncWidth = 32,
  50. parameter NcoWidth = 18
  51. )
  52. (
  53. //common ports
  54. input Clk_i,
  55. //fpga-adc1 data interface
  56. input Adc1FclkP_i,
  57. input Adc1FclkN_i,
  58. input Adc1DataDa0P_i,
  59. input Adc1DataDa0N_i,
  60. input Adc1DataDa1P_i,
  61. input Adc1DataDa1N_i,
  62. input Adc1DataDb0P_i,
  63. input Adc1DataDb0N_i,
  64. input Adc1DataDb1P_i,
  65. input Adc1DataDb1N_i,
  66. //fpga-adc2 data interface
  67. input Adc2FclkP_i,
  68. input Adc2FclkN_i,
  69. input Adc2DataDa0P_i,
  70. input Adc2DataDa0N_i,
  71. input Adc2DataDa1P_i,
  72. input Adc2DataDa1N_i,
  73. input Adc2DataDb0P_i,
  74. input Adc2DataDb0N_i,
  75. input Adc2DataDb1P_i,
  76. input Adc2DataDb1N_i,
  77. //fpga-adc's initialization interface
  78. output AdcInitMosi_o,
  79. output AdcInitClk_o,
  80. output Adc1InitCs_o,
  81. output Adc2InitCs_o,
  82. output AdcInitRst_o,
  83. //ditherCtrl
  84. output DitherCtrlCh1_o,
  85. output DitherCtrlCh2_o,
  86. //fpga-dsp cmd interface
  87. input Mosi_i,
  88. input Sck_i,
  89. input Ss_i,
  90. // input Miso_i,
  91. output Miso_o,
  92. //fpga-dsp data interface
  93. output LpOutClk_o,
  94. output LpOutFs_o,
  95. output [LpDataWidth-1:0] LpOutData_o,
  96. //fpga-dsp signals
  97. input StartMeasDsp_i, //"high"- start meas, "low"-stop meas
  98. input StartMeasEvent_i,
  99. //overload lines
  100. output Overload_o,
  101. //gain lines
  102. input DspReadyForRx_i,
  103. output [ChNum-1:0] AmpEn_o, // 0-adc1ChA 1-adc1ChB 2-adc2ChA 3-adc2ChB
  104. ///test port for testbench
  105. input [AdcDataWidth-1:0] AdcData_i
  106. );
  107. //================================================================================
  108. // reg/wire
  109. //================================================================================
  110. //captured data
  111. wire [AdcDataWidth-1:0] adc1ChT1Data;
  112. wire [AdcDataWidth-1:0] adc1ChR1Data;
  113. wire [AdcDataWidth-1:0] adc2ChR2Data;
  114. wire [AdcDataWidth-1:0] adc2ChT2Data;
  115. reg startMeasSync;
  116. wire intTrig1;
  117. reg startMeasEventReg;
  118. wire startMeasEventPos = (!startMeasEventReg&StartMeasEvent_i);
  119. wire intTrig;
  120. wire trigForIntTrig2;
  121. wire intTrig2;
  122. wire gatingPulse;
  123. wire sampleStrobe;
  124. wire [ChNum-1:0] measStartBus;
  125. reg measStart;
  126. //spi signals for adc init
  127. wire adcInitRst;
  128. wire adcInitMosi;
  129. wire adcInitSck;
  130. wire adc0InitCs;
  131. wire adc1InitCs;
  132. wire [ResultWidth-1:0] adc1ImT1;
  133. wire [ResultWidth-1:0] adc1ReT1;
  134. wire [ResultWidth-1:0] adc1ImR1;
  135. wire [ResultWidth-1:0] adc1ReR1;
  136. wire [ResultWidth-1:0] adc2ImT2;
  137. wire [ResultWidth-1:0] adc2ReT2;
  138. wire [ResultWidth-1:0] adc2ImR2;
  139. wire [ResultWidth-1:0] adc2ReR2;
  140. wire measDataRdy;
  141. wire timersClk;
  142. wire [ThresholdWidth-1:0] lowThreshold;
  143. wire [ThresholdWidth-1:0] highThreshold;
  144. wire initRst;
  145. wire gclk;
  146. reg ledReg;
  147. wire [CmdRegWidth-1:0] cmdDataReg;
  148. wire cmdDataVal;
  149. wire [CmdDataRegWith-1:0] ansReg;
  150. wire [HeaderWidth-1:0] ansAddr;
  151. wire [CmdDataRegWith-1:0] gainCtrl;
  152. wire [CmdDataRegWith-1:0] gainLowThreshT1;
  153. wire [CmdDataRegWith-1:0] gainHighThreshT1;
  154. wire [CmdDataRegWith-1:0] gainLowThreshR1;
  155. wire [CmdDataRegWith-1:0] gainHighThreshR1;
  156. wire [CmdDataRegWith-1:0] gainLowThreshT2;
  157. wire [CmdDataRegWith-1:0] gainHighThreshT2;
  158. wire [CmdDataRegWith-1:0] gainLowThreshR2;
  159. wire [CmdDataRegWith-1:0] gainHighThreshR2;
  160. wire [ChNum-1:0] overCtrlChannels;
  161. wire [CmdDataRegWith-1:0] overCtrl = {{CmdDataRegWith-ChNum{1'b0}},overCtrlChannels};
  162. wire [CmdDataRegWith-1:0] overThresh;
  163. wire [CmdDataRegWith-1:0] ditherCtrl;
  164. wire [CmdDataRegWith-1:0] windowGenPhase1;
  165. wire [CmdDataRegWith-1:0] windowGenPhase2;
  166. wire [CmdDataRegWith-1:0] adcCtrl;
  167. wire [CmdDataRegWith-1:0] adcDirectRd0;
  168. wire [CmdDataRegWith-1:0] adcDirectRd1;
  169. wire [CmdDataRegWith-1:0] ifFtwL;
  170. wire [CmdDataRegWith-1:0] ifFtwH;
  171. wire [CmdDataRegWith-1:0] measCtrl;
  172. wire [CmdDataRegWith-1:0] amplitudeMod;
  173. wire [CmdDataRegWith-1:0] dspTrigIn;
  174. wire [CmdDataRegWith-1:0] dspTrigOut;
  175. wire [CmdDataRegWith-1:0] dspTrigIn1;
  176. wire [CmdDataRegWith-1:0] dspTrigIn2;
  177. wire [CmdDataRegWith-1:0] dspTrigOut1;
  178. wire [CmdDataRegWith-1:0] dspTrigOut2;
  179. wire [CmdDataRegWith-1:0] filterCorrCoefL;
  180. wire [CmdDataRegWith-1:0] filterCorrCoefH;
  181. wire trigToDsp0;
  182. wire trigToDsp1;
  183. wire intTrigToExtDev0;
  184. wire intTrigToExtDev1;
  185. wire delayDoneFlag0;
  186. wire delayDoneFlag1;
  187. wire trigEn0;
  188. wire trigEn1;
  189. wire stopMeas;
  190. reg stopMeasR;
  191. wire [NcoWidth-1:0] ncoCos;
  192. wire [NcoWidth-1:0] ncoSin;
  193. wire [CmdDataRegWith-1:0] gainLowThresholdBus [ChNum-1:0];
  194. wire [CmdDataRegWith-1:0] gainHighThresholdBus [ChNum-1:0];
  195. wire [ChNum-1:0] ampEnNewStates;
  196. wire [ChNum-1:0] sensEn;
  197. wire [ChNum-1:0] gainManual;
  198. wire [ChNum-1:0] gainAutoEn;
  199. wire [AdcDataWidth-1:0] adcDataBus [ChNum-1:0];
  200. wire overCtrlR = |overCtrlChannels[ChNum-1:0];
  201. localparam TESTCNTPARAM = 32'd100000000;
  202. reg [31:0] testCnt;
  203. wire refClk;
  204. wire Clk100_o;
  205. wire measWind;
  206. wire measTrig;
  207. wire measTrigVal;
  208. wire refSeqPulse;
  209. wire refSeq;
  210. //Pmeas wires
  211. //PG1 Regs
  212. wire [CmdDataRegWith-1:0] pG1P1Del;
  213. wire [CmdDataRegWith-1:0] pG1P2Del;
  214. wire [CmdDataRegWith-1:0] pG1P3Del;
  215. wire [CmdDataRegWith-1:0] pG1P123Del;
  216. wire [CmdDataRegWith-1:0] pG1P1Width;
  217. wire [CmdDataRegWith-1:0] pG1P2Width;
  218. wire [CmdDataRegWith-1:0] pG1P3Width;
  219. wire [CmdDataRegWith-1:0] pG1P123Width;
  220. //PG2 Regs
  221. wire [CmdDataRegWith-1:0] pG2P1Del;
  222. wire [CmdDataRegWith-1:0] pG2P2Del;
  223. wire [CmdDataRegWith-1:0] pG2P3Del;
  224. wire [CmdDataRegWith-1:0] pG2P123Del;
  225. wire [CmdDataRegWith-1:0] pG2P1Width;
  226. wire [CmdDataRegWith-1:0] pG2P2Width;
  227. wire [CmdDataRegWith-1:0] pG2P3Width;
  228. wire [CmdDataRegWith-1:0] pG2P123Width;
  229. //PG3 Regs
  230. wire [CmdDataRegWith-1:0] pG3P1Del;
  231. wire [CmdDataRegWith-1:0] pG3P2Del;
  232. wire [CmdDataRegWith-1:0] pG3P3Del;
  233. wire [CmdDataRegWith-1:0] pG3P123Del;
  234. wire [CmdDataRegWith-1:0] pG3P1Width;
  235. wire [CmdDataRegWith-1:0] pG3P2Width;
  236. wire [CmdDataRegWith-1:0] pG3P3Width;
  237. wire [CmdDataRegWith-1:0] pG3P123Width;
  238. //PG4 Regs
  239. wire [CmdDataRegWith-1:0] pG4P1Del;
  240. wire [CmdDataRegWith-1:0] pG4P2Del;
  241. wire [CmdDataRegWith-1:0] pG4P3Del;
  242. wire [CmdDataRegWith-1:0] pG4P123Del;
  243. wire [CmdDataRegWith-1:0] pG4P1Width;
  244. wire [CmdDataRegWith-1:0] pG4P2Width;
  245. wire [CmdDataRegWith-1:0] pG4P3Width;
  246. wire [CmdDataRegWith-1:0] pG4P123Width;
  247. //PG5 Regs
  248. wire [CmdDataRegWith-1:0] pG5P1Del;
  249. wire [CmdDataRegWith-1:0] pG5P2Del;
  250. wire [CmdDataRegWith-1:0] pG5P3Del;
  251. wire [CmdDataRegWith-1:0] pG5P123Del;
  252. wire [CmdDataRegWith-1:0] pG5P1Width;
  253. wire [CmdDataRegWith-1:0] pG5P2Width;
  254. wire [CmdDataRegWith-1:0] pG5P3Width;
  255. wire [CmdDataRegWith-1:0] pG5P123Width;
  256. //PG6 Regs
  257. wire [CmdDataRegWith-1:0] pG6P1Del;
  258. wire [CmdDataRegWith-1:0] pG6P2Del;
  259. wire [CmdDataRegWith-1:0] pG6P3Del;
  260. wire [CmdDataRegWith-1:0] pG6P123Del;
  261. wire [CmdDataRegWith-1:0] pG6P1Width;
  262. wire [CmdDataRegWith-1:0] pG6P2Width;
  263. wire [CmdDataRegWith-1:0] pG6P3Width;
  264. wire [CmdDataRegWith-1:0] pG6P123Width;
  265. //PG7 Regs
  266. wire [CmdDataRegWith-1:0] pG7P1Del;
  267. wire [CmdDataRegWith-1:0] pG7P2Del;
  268. wire [CmdDataRegWith-1:0] pG7P3Del;
  269. wire [CmdDataRegWith-1:0] pG7P123Del;
  270. wire [CmdDataRegWith-1:0] pG7P1Width;
  271. wire [CmdDataRegWith-1:0] pG7P2Width;
  272. wire [CmdDataRegWith-1:0] pG7P3Width;
  273. wire [CmdDataRegWith-1:0] pG7P123Width;
  274. wire [CmdDataRegWith-1:0] measNum1;
  275. wire [CmdDataRegWith-1:0] measNum2;
  276. wire [CmdDataRegWith-1:0] pgMode0;
  277. wire [CmdDataRegWith-1:0] pgMode1;
  278. wire [CmdDataRegWith-1:0] muxCtrl1;
  279. wire [CmdDataRegWith-1:0] muxCtrl2;
  280. wire [CmdDataRegWith-1:0] muxCtrl3;
  281. wire [CmdDataRegWith-1:0] muxCtrl4;
  282. wire [CmdRegWidth-29:0] pgModeArray [PGenNum-1:0];
  283. wire pgPulsePolArray [PGenNum-1:0];
  284. wire pgEnEdgeArray [PGenNum-1:0];
  285. wire [PGenNum-1:0] pgRstArray;
  286. wire [6:0] pGenRst;
  287. wire [6:0] pGenMeasRst;
  288. wire pGenRstDone;
  289. wire [CmdRegWidth-28:0] pgMuxCtrlArray [PGenNum-1:0];
  290. wire [CmdRegWidth-28:0] extTrigMuxCtrlArray [TrigPortsNum-1:0];
  291. wire [TrigPortsNum-1:0] extTrigDirCmd = measCtrl[21:16];
  292. wire [CmdRegWidth-1:0] pgP1DelArray [PGenNum-1:0];
  293. wire [CmdRegWidth-1:0] pgP2DelArray [PGenNum-1:0];
  294. wire [CmdRegWidth-1:0] pgP3DelArray [PGenNum-1:0];
  295. wire [CmdRegWidth-1:0] pgP1WidthArray [PGenNum-1:0];
  296. wire [CmdRegWidth-1:0] pgP2WidthArray [PGenNum-1:0];
  297. wire [CmdRegWidth-1:0] pgP3WidthArray [PGenNum-1:0];
  298. wire [PGenNum-1:0] pulseBus;
  299. wire [PGenNum-1:0] pgMuxedOut;
  300. wire [TrigPortsNum-1:0] extPortsMuxedOut;
  301. wire measEnd;
  302. wire modOut;
  303. wire [3:0] modKeyCtrl;
  304. wire tirgToDspEvent;
  305. wire trigFromDspEvent;
  306. wire oscWind;
  307. wire oscDataRdFlag;
  308. wire dspBusy;
  309. wire fifoEn;
  310. reg dspReadyForRxReg;
  311. //================================================================================
  312. // assignments
  313. //================================================================================
  314. assign pgModeArray [PGenNum-1] = pgMode0[21:18];
  315. assign pgModeArray [PGenNum-2] = pgMode0[17:15];
  316. assign pgModeArray [PGenNum-3] = pgMode0[14:12];
  317. assign pgModeArray [PGenNum-4] = pgMode0[11:9];
  318. assign pgModeArray [PGenNum-5] = pgMode0[8:6];
  319. assign pgModeArray [PGenNum-6] = pgMode0[5:3];
  320. assign pgModeArray [PGenNum-7] = pgMode0[2:0];
  321. assign pgPulsePolArray [PGenNum-1] = pgMode1[16];
  322. assign pgPulsePolArray [PGenNum-2] = pgMode1[15];
  323. assign pgPulsePolArray [PGenNum-3] = pgMode1[14];
  324. assign pgPulsePolArray [PGenNum-4] = pgMode1[13];
  325. assign pgPulsePolArray [PGenNum-5] = pgMode1[12];
  326. assign pgPulsePolArray [PGenNum-6] = pgMode1[11];
  327. assign pgPulsePolArray [PGenNum-7] = pgMode1[10];
  328. assign pgEnEdgeArray [PGenNum-1] = pgMode1[23];
  329. assign pgEnEdgeArray [PGenNum-2] = pgMode1[22];
  330. assign pgEnEdgeArray [PGenNum-3] = pgMode1[21];
  331. assign pgEnEdgeArray [PGenNum-4] = pgMode1[20];
  332. assign pgEnEdgeArray [PGenNum-5] = pgMode1[19];
  333. assign pgEnEdgeArray [PGenNum-6] = pgMode1[18];
  334. assign pgEnEdgeArray [PGenNum-7] = pgMode1[17];
  335. assign pgRstArray [PGenNum-1] = pgMode1[6];
  336. assign pgRstArray [PGenNum-2] = pgMode1[5];
  337. assign pgRstArray [PGenNum-3] = pgMode1[4];
  338. assign pgRstArray [PGenNum-4] = pgMode1[3];
  339. assign pgRstArray [PGenNum-5] = pgMode1[2];
  340. assign pgRstArray [PGenNum-6] = pgMode1[1];
  341. assign pgRstArray [PGenNum-7] = pgMode1[0];
  342. assign pgMuxCtrlArray [PGenNum-1] = muxCtrl1[19:15];
  343. assign pgMuxCtrlArray [PGenNum-2] = muxCtrl1[14:10];
  344. assign pgMuxCtrlArray [PGenNum-3] = muxCtrl1[9:5];
  345. assign pgMuxCtrlArray [PGenNum-4] = muxCtrl1[4:0];
  346. assign pgMuxCtrlArray [PGenNum-5] = muxCtrl2[19:15];
  347. assign pgMuxCtrlArray [PGenNum-6] = muxCtrl2[14:10];
  348. assign pgMuxCtrlArray [PGenNum-7] = muxCtrl2[9:5];
  349. assign extTrigMuxCtrlArray [TrigPortsNum-1] = muxCtrl4[19:15];
  350. assign extTrigMuxCtrlArray [TrigPortsNum-2] = muxCtrl4[14:10];
  351. assign extTrigMuxCtrlArray [TrigPortsNum-3] = muxCtrl4[9:5];
  352. assign extTrigMuxCtrlArray [TrigPortsNum-4] = muxCtrl4[4:0];
  353. assign extTrigMuxCtrlArray [TrigPortsNum-5] = muxCtrl3[9:5];
  354. assign extTrigMuxCtrlArray [TrigPortsNum-6] = muxCtrl3[4:0];
  355. assign pgP1DelArray[PGenNum-1] = {pG7P123Del[7:0],pG7P1Del};
  356. assign pgP1DelArray[PGenNum-2] = {pG6P123Del[7:0],pG6P1Del};
  357. assign pgP1DelArray[PGenNum-3] = {pG5P123Del[7:0],pG5P1Del};
  358. assign pgP1DelArray[PGenNum-4] = {pG4P123Del[7:0],pG4P1Del};
  359. assign pgP1DelArray[PGenNum-5] = {pG3P123Del[7:0],pG3P1Del};
  360. assign pgP1DelArray[PGenNum-6] = {pG2P123Del[7:0],pG2P1Del};
  361. assign pgP1DelArray[PGenNum-7] = {pG1P123Del[7:0],pG1P1Del};
  362. assign pgP2DelArray[PGenNum-1] = {pG7P123Del[15:8],pG7P2Del};
  363. assign pgP2DelArray[PGenNum-2] = {pG6P123Del[15:8],pG6P2Del};
  364. assign pgP2DelArray[PGenNum-3] = {pG5P123Del[15:8],pG5P2Del};
  365. assign pgP2DelArray[PGenNum-4] = {pG4P123Del[15:8],pG4P2Del};
  366. assign pgP2DelArray[PGenNum-5] = {pG3P123Del[15:8],pG3P2Del};
  367. assign pgP2DelArray[PGenNum-6] = {pG2P123Del[15:8],pG2P2Del};
  368. assign pgP2DelArray[PGenNum-7] = {pG1P123Del[15:8],pG1P2Del};
  369. assign pgP3DelArray[PGenNum-1] = {pG7P123Del[23:16],pG7P3Del};
  370. assign pgP3DelArray[PGenNum-2] = {pG6P123Del[23:16],pG6P3Del};
  371. assign pgP3DelArray[PGenNum-3] = {pG5P123Del[23:16],pG5P3Del};
  372. assign pgP3DelArray[PGenNum-4] = {pG4P123Del[23:16],pG4P3Del};
  373. assign pgP3DelArray[PGenNum-5] = {pG3P123Del[23:16],pG3P3Del};
  374. assign pgP3DelArray[PGenNum-6] = {pG2P123Del[23:16],pG2P3Del};
  375. assign pgP3DelArray[PGenNum-7] = {pG1P123Del[23:16],pG1P3Del};
  376. assign pgP1WidthArray[PGenNum-1] = {pG7P123Width[7:0],pG7P1Width};
  377. assign pgP1WidthArray[PGenNum-2] = {pG6P123Width[7:0],pG6P1Width};
  378. assign pgP1WidthArray[PGenNum-3] = {pG5P123Width[7:0],pG5P1Width};
  379. assign pgP1WidthArray[PGenNum-4] = {pG4P123Width[7:0],pG4P1Width};
  380. assign pgP1WidthArray[PGenNum-5] = {pG3P123Width[7:0],pG3P1Width};
  381. assign pgP1WidthArray[PGenNum-6] = {pG2P123Width[7:0],pG2P1Width};
  382. assign pgP1WidthArray[PGenNum-7] = {pG1P123Width[7:0],pG1P1Width};
  383. assign pgP2WidthArray[PGenNum-1] = {pG7P123Width[15:8],pG7P2Width};
  384. assign pgP2WidthArray[PGenNum-2] = {pG6P123Width[15:8],pG6P2Width};
  385. assign pgP2WidthArray[PGenNum-3] = {pG5P123Width[15:8],pG5P2Width};
  386. assign pgP2WidthArray[PGenNum-4] = {pG4P123Width[15:8],pG4P2Width};
  387. assign pgP2WidthArray[PGenNum-5] = {pG3P123Width[15:8],pG3P2Width};
  388. assign pgP2WidthArray[PGenNum-6] = {pG2P123Width[15:8],pG2P2Width};
  389. assign pgP2WidthArray[PGenNum-7] = {pG1P123Width[15:8],pG1P2Width};
  390. assign pgP3WidthArray[PGenNum-1] = {pG7P123Width[23:16],pG7P3Width};
  391. assign pgP3WidthArray[PGenNum-2] = {pG6P123Width[23:16],pG6P3Width};
  392. assign pgP3WidthArray[PGenNum-3] = {pG5P123Width[23:16],pG5P3Width};
  393. assign pgP3WidthArray[PGenNum-4] = {pG4P123Width[23:16],pG4P3Width};
  394. assign pgP3WidthArray[PGenNum-5] = {pG3P123Width[23:16],pG3P3Width};
  395. assign pgP3WidthArray[PGenNum-6] = {pG2P123Width[23:16],pG2P3Width};
  396. assign pgP3WidthArray[PGenNum-7] = {pG1P123Width[23:16],pG1P3Width};
  397. assign adcDataBus [ChNum-4] = adc1ChT1Data;
  398. assign adcDataBus [ChNum-3] = adc1ChR1Data;
  399. assign adcDataBus [ChNum-2] = adc2ChR2Data;
  400. assign adcDataBus [ChNum-1] = adc2ChT2Data;
  401. assign gainManual [ChNum-4] = gainCtrl[5];
  402. assign gainManual [ChNum-3] = gainCtrl[4];
  403. assign gainManual [ChNum-2] = gainCtrl[6];
  404. assign gainManual [ChNum-1] = gainCtrl[7];
  405. assign gainAutoEn [ChNum-4] = gainCtrl[1];
  406. assign gainAutoEn [ChNum-3] = gainCtrl[0];
  407. assign gainAutoEn [ChNum-2] = gainCtrl[2];
  408. assign gainAutoEn [ChNum-1] = gainCtrl[3];
  409. assign AdcInitMosi_o = adcInitMosi;
  410. assign AdcInitClk_o = adcInitSck;
  411. assign Adc1InitCs_o = adc0InitCs;
  412. assign Adc2InitCs_o = adc1InitCs;
  413. assign AdcInitRst_o = adcCtrl[0];
  414. // assign Led_o = ledReg &(adc1ImT1|adc1ReT1|adc1ImR1|adc1ReR1|adc2ImT2|adc2ReT2|adc2ImR2|adc2ReR2);
  415. assign EndMeas_o = stopMeas|stopMeasR; //stretching pulse for 1 more clk period
  416. assign gainLowThresholdBus [ChNum-4] = gainLowThreshT1;
  417. assign gainLowThresholdBus [ChNum-3] = gainLowThreshR1;
  418. assign gainLowThresholdBus [ChNum-2] = gainLowThreshR2;
  419. assign gainLowThresholdBus [ChNum-1] = gainLowThreshT2;
  420. assign gainHighThresholdBus [ChNum-4] = gainHighThreshT1;
  421. assign gainHighThresholdBus [ChNum-3] = gainHighThreshR1;
  422. assign gainHighThresholdBus [ChNum-2] = gainHighThreshR2;
  423. assign gainHighThresholdBus [ChNum-1] = gainHighThreshT2;
  424. assign AmpEn_o [3] = ~ampEnNewStates[3];
  425. assign AmpEn_o [2] = ~ampEnNewStates[2];
  426. assign AmpEn_o [1] = ~ampEnNewStates[0];
  427. assign AmpEn_o [0] = ~ampEnNewStates[1];
  428. assign Overload_o = overCtrlR;
  429. // assign Overload_o = intTrig2;
  430. //================================================================================
  431. // CODING
  432. //================================================================================
  433. integer m;
  434. always @(posedge gclk) begin
  435. stopMeasR <= stopMeas;
  436. end
  437. always @(posedge gclk) begin
  438. if (!initRst) begin
  439. dspReadyForRxReg <= DspReadyForRx_i;
  440. end else begin
  441. dspReadyForRxReg <= 1'b0;
  442. end
  443. end
  444. //--------------------------------------------------------------------------------
  445. // Data Receiving Interface
  446. //--------------------------------------------------------------------------------
  447. IBUF iob_50m_in
  448. (
  449. .I (Clk_i),
  450. .O (gclk)
  451. );
  452. Clk200Gen Clk200Gen
  453. (
  454. .Clk_i (gclk),
  455. .Rst_i (initRst),
  456. .Clk200_o (refClk),
  457. .Clk10Timers_o (TimersClk_o),
  458. .Clk100_o (Clk100_o),
  459. .Locked_o (Locked200)
  460. );
  461. AdcDataInterface
  462. #(
  463. .AdcDataWidth (AdcDataWidth),
  464. .ChNum (ChNum),
  465. .Ratio (Ratio)
  466. )
  467. AdcDataInterface
  468. (
  469. .Clk_i (gclk),
  470. .RefClk_i (refClk),
  471. .Locked_i (Locked200),
  472. .Rst_i (initRst),
  473. .Adc1FclkP_i (Adc1FclkP_i),
  474. .Adc1FclkN_i (Adc1FclkN_i),
  475. .Adc1DataDa0P_i (Adc1DataDa0P_i),
  476. .Adc1DataDa0N_i (Adc1DataDa0N_i),
  477. .Adc1DataDa1P_i (Adc1DataDa1P_i),
  478. .Adc1DataDa1N_i (Adc1DataDa1N_i),
  479. .Adc1DataDb0P_i (Adc1DataDb0P_i),
  480. .Adc1DataDb0N_i (Adc1DataDb0N_i),
  481. .Adc1DataDb1P_i (Adc1DataDb1P_i),
  482. .Adc1DataDb1N_i (Adc1DataDb1N_i),
  483. .Adc2FclkP_i (Adc2FclkP_i),
  484. .Adc2FclkN_i (Adc2FclkN_i),
  485. .Adc2DataDa0P_i (Adc2DataDa0P_i),
  486. .Adc2DataDa0N_i (Adc2DataDa0N_i),
  487. .Adc2DataDa1P_i (Adc2DataDa1P_i),
  488. .Adc2DataDa1N_i (Adc2DataDa1N_i),
  489. .Adc2DataDb0P_i (Adc2DataDb0P_i),
  490. .Adc2DataDb0N_i (Adc2DataDb0N_i),
  491. .Adc2DataDb1P_i (Adc2DataDb1P_i),
  492. .Adc2DataDb1N_i (Adc2DataDb1N_i),
  493. .Adc1ChT1Data_o (adc1ChT1Data),
  494. .Adc1ChR1Data_o (adc1ChR1Data),
  495. .Adc2ChR2Data_o (adc2ChR2Data),
  496. .Adc2ChT2Data_o (adc2ChT2Data)
  497. );
  498. //--------------------------------------------------------------------------------
  499. // External DSP Interface
  500. //--------------------------------------------------------------------------------
  501. DspInterface
  502. #(
  503. .ODataWidth (LpDataWidth),
  504. .ResultWidth (ResultWidth),
  505. .ChNum (ChNum),
  506. .CmdRegWidth (CmdRegWidth),
  507. .CmdDataRegWith (CmdDataRegWith),
  508. .HeaderWidth (HeaderWidth),
  509. .DataCntWidth (DataCntWidth)
  510. )
  511. ExternalDspInterface
  512. (
  513. .Clk_i (gclk),
  514. .Rst_i (initRst),
  515. .OscWind_i (oscWind),
  516. .StartMeasDsp_i (startMeasSync),
  517. // .DspReadyForRx_i (dspReadyForRxReg),
  518. .DspReadyForRx_i (dspReadyForRxReg),
  519. .MeasNum_i ({measNum2[7:0],measNum1}),
  520. .Mosi_i (Mosi_i),
  521. .Sck_i (Sck_i),
  522. .Ss_i (Ss_i),
  523. .Mode_i (measCtrl[0]),
  524. .PortSel_i (measCtrl[23:22]),
  525. .DecimFactor_i (measCtrl[3:1]),
  526. .IfFtwL_i (ifFtwL),
  527. .IfFtwH_i (ifFtwH),
  528. .OscDataRdFlag_o (oscDataRdFlag),
  529. .Adc1ChT1Data_i (adc1ChT1Data),
  530. .Adc1ChR1Data_i (adc1ChR1Data),
  531. .Adc2ChR2Data_i (adc2ChT2Data),
  532. .Adc2ChT2Data_i (adc2ChR2Data),
  533. // .Adc1ChT1Data_i (AdcData_i),
  534. // .Adc1ChR1Data_i (AdcData_i),
  535. // .Adc2ChR2Data_i (AdcData_i),
  536. // .Adc2ChT2Data_i (AdcData_i),
  537. // .Adc1ChT1Data_i (14'h1fff),
  538. // .Adc1ChR1Data_i (14'h257f),
  539. // .Adc2ChR2Data_i (14'h1001),
  540. // .Adc2ChT2Data_i (14'h25f8),
  541. .Mosi_o (adcInitMosi),
  542. .Sck_o (adcInitSck),
  543. .Ss0_o (adc0InitCs),
  544. .Ss1_o (adc1InitCs),
  545. .Miso_i (Miso_i),
  546. .Miso_o (Miso_o),
  547. .CmdDataReg_o (cmdDataReg),
  548. .CmdDataVal_o (cmdDataVal),
  549. .AnsReg_i (ansReg),
  550. .AnsAddr_o (ansAddr),
  551. .LpOutFs_o (LpOutFs_o),
  552. .LpOutClk_o (LpOutClk_o),
  553. .LpOutData_o (LpOutData_o),
  554. .Adc1T1ImResult_i (adc1ImT1),
  555. .Adc1T1ReResult_i (adc1ReT1),
  556. .Adc1R1ImResult_i (adc1ImR1),
  557. .Adc1R1ReResult_i (adc1ReR1),
  558. .Adc2R2ImResult_i (adc2ImR2),
  559. .Adc2R2ReResult_i (adc2ReR2),
  560. .Adc2T2ImResult_i (adc2ImT2),
  561. .Adc2T2ReResult_i (adc2ReT2),
  562. .ServiseRegData_i (ampEnNewStates),
  563. .LpOutStart_i (measDataRdy)
  564. );
  565. //--------------------------------------------------------------------------------
  566. // Internal DSP calculation module
  567. //--------------------------------------------------------------------------------
  568. always @(posedge gclk) begin
  569. if (!initRst) begin
  570. startMeasSync <= StartMeasDsp_i;
  571. end else begin
  572. startMeasSync <= 1'b0;
  573. end
  574. end
  575. always @(posedge gclk) begin
  576. if (!initRst) begin
  577. startMeasEventReg <= StartMeasEvent_i;
  578. end else begin
  579. startMeasEventReg <= 0;
  580. end
  581. end
  582. NcoRstGen NcoRstGenInst
  583. (
  584. .Clk_i (gclk),
  585. .Rst_i (initRst),
  586. .NcoPhInc_i ({ifFtwH[0+:PhIncWidth-CmdDataRegWith],ifFtwL}),
  587. .StartMeasEvent_i (StartMeasEvent_i),
  588. .NcoRst_o (ncoRst),
  589. .StartMeasEvent_o (intTrig1)
  590. );
  591. //--------------------------------------------------------------------------------
  592. // IntTrig2 Mux
  593. //--------------------------------------------------------------------------------
  594. TrigInt2Mux
  595. #(
  596. .PGenNum (PGenNum)
  597. )
  598. InitTrig2Mux
  599. (
  600. .Rst_i (initRst),
  601. .MuxCtrl_i (muxCtrl3[23:20]),
  602. .PulseBus_i (pulseBus),
  603. .MuxOut_o (trigForIntTrig2)
  604. );
  605. //--------------------------------------------------------------------------------
  606. // MeasStartEventGen
  607. //--------------------------------------------------------------------------------
  608. MeasStartEventGen IntTrig2GenInst
  609. (
  610. .Rst_i (initRst),
  611. .Clk_i (gclk),
  612. .MeasTrig_i (trigForIntTrig2),
  613. .StartMeasDsp_i (intTrig1),
  614. .StartMeasEvent_o (),
  615. .InitTrig_o (intTrig2)
  616. );
  617. InternalDsp
  618. #(
  619. .AdcDataWidth (AdcDataWidth),
  620. .ChNum (ChNum),
  621. .ResultWidth (ResultWidth),
  622. .CmdDataRegWith (CmdDataRegWith)
  623. )
  624. InternalDsp
  625. (
  626. .Clk_i (gclk),
  627. .WindCalcClk_i (Clk100_o),
  628. .Rst_i (initRst),
  629. .NcoRst_i (ncoRst),
  630. .OscWind_o (oscWind),
  631. .Adc1ChT1Data_i (adc1ChT1Data), //T1
  632. .Adc1ChR1Data_i (adc1ChR1Data), //R1
  633. .Adc2ChR2Data_i (adc2ChR2Data), //R2
  634. .Adc2ChT2Data_i (adc2ChT2Data), //T2
  635. // .Adc1ChT1Data_i (AdcData_i), //T1
  636. // .Adc1ChR1Data_i (AdcData_i), //R1
  637. // .Adc2ChR2Data_i (AdcData_i), //R2
  638. // .Adc2ChT2Data_i (AdcData_i), //T2
  639. .GatingPulse_i (gatingPulse),
  640. .StartMeas_i (measStart),
  641. .StartMeasDsp_i (startMeasSync),
  642. .OscDataRdFlag_i (oscDataRdFlag),
  643. .MeasNum_i ({measNum2[7:0],measNum1}),
  644. .MeasCtrl_i (measCtrl),
  645. .FilterCorrCoefH_i (filterCorrCoefH),
  646. .FilterCorrCoefL_i (filterCorrCoefL),
  647. .CalModeEn_i (adcCtrl[1]),
  648. .CalModeDone_o (calDone),
  649. .IfFtwL_i (ifFtwL),
  650. .IfFtwH_i (ifFtwH),
  651. .NcoSin_o (ncoSin),
  652. .NcoCos_o (ncoCos),
  653. .Adc1ImT1Data_o (adc1ImT1),
  654. .Adc1ReT1Data_o (adc1ReT1),
  655. .Adc1ImR1Data_o (adc1ImR1),
  656. .Adc1ReR1Data_o (adc1ReR1),
  657. .Adc2ImR2Data_o (adc2ImR2),
  658. .Adc2ReR2Data_o (adc2ReR2),
  659. .Adc2ImT2Data_o (adc2ImT2),
  660. .Adc2ReT2Data_o (adc2ReT2),
  661. .MeasDataRdy_o (measDataRdy),
  662. .EndMeas_o (stopMeas),
  663. .MeasWind_o (measWind),
  664. .MeasEnd_o (measEnd)
  665. );
  666. //--------------------------------------------------------------------------------
  667. // Reg Map With Config Registers
  668. //--------------------------------------------------------------------------------
  669. RegMap
  670. #(
  671. .CmdRegWidth (CmdRegWidth),
  672. .HeaderWidth (HeaderWidth),
  673. .CmdDataRegWith (CmdDataRegWith)
  674. )
  675. RegMapInst
  676. (
  677. .Clk_i (gclk),
  678. .Rst_i (initRst),
  679. .PGenRstDone_i (pGenRstDone),
  680. .Val_i (cmdDataVal),
  681. .CalDone_i (calDone),
  682. .Data_i (cmdDataReg),
  683. .AnsAddr_i (ansAddr),
  684. .AnsDataReg_o (ansReg),
  685. .OverCtrlReg_i (overCtrl),
  686. .GainCtrlReg_o (gainCtrl),
  687. .GainLowThreshT1Reg_o (gainLowThreshT1),
  688. .GainHighThreshT1Reg_o (gainHighThreshT1),
  689. .GainLowThreshR1Reg_o (gainLowThreshR1),
  690. .GainHighThreshR1Reg_o (gainHighThreshR1),
  691. .GainLowThreshT2Reg_o (gainLowThreshT2),
  692. .GainHighThreshT2Reg_o (gainHighThreshT2),
  693. .GainLowThreshR2Reg_o (gainLowThreshR2),
  694. .GainHighThreshR2Reg_o (gainHighThreshR2),
  695. .OverThreshReg_o (overThresh),
  696. .DitherCtrlReg_o (ditherCtrl),
  697. .MeasCtrlReg_o (measCtrl),
  698. .AdcCtrlReg_o (adcCtrl),
  699. .AdcDirectRd0Reg_o (adcDirectRd0),
  700. .AdcDirectRd1Reg_o (adcDirectRd1),
  701. .IfFtwRegL_o (ifFtwL),
  702. .IfFtwRegH_o (ifFtwH),
  703. .FilterCorrCoefRegL_o (filterCorrCoefL),
  704. .FilterCorrCoefRegH_o (filterCorrCoefH),
  705. .DspTrigInReg_o (dspTrigIn),
  706. .DspTrigOutReg_o (dspTrigOut),
  707. .DspTrigIn1Reg_o (dspTrigIn1),
  708. .DspTrigIn2Reg_o (dspTrigIn2),
  709. .DspTrigOut1Reg_o (dspTrigOut1),
  710. .DspTrigOut2Reg_o (dspTrigOut2),
  711. .PG1P1DelayReg_o (pG1P1Del),
  712. .PG1P2DelayReg_o (pG1P2Del),
  713. .PG1P3DelayReg_o (pG1P3Del),
  714. .PG1P123DelayReg_o (pG1P123Del),
  715. .PG1P1WidthReg_o (pG1P1Width),
  716. .PG1P2WidthReg_o (pG1P2Width),
  717. .PG1P3WidthReg_o (pG1P3Width),
  718. .PG1P123WidthReg_o (pG1P123Width),
  719. //PG2 Regs
  720. .PG2P1DelayReg_o (pG2P1Del),
  721. .PG2P2DelayReg_o (pG2P2Del),
  722. .PG2P3DelayReg_o (pG2P3Del),
  723. .PG2P123DelayReg_o (pG2P123Del),
  724. .PG2P1WidthReg_o (pG2P1Width),
  725. .PG2P2WidthReg_o (pG2P2Width),
  726. .PG2P3WidthReg_o (pG2P3Width),
  727. .PG2P123WidthReg_o (pG2P123Width),
  728. //PG3 Regs
  729. .PG3P1DelayReg_o (pG3P1Del),
  730. .PG3P2DelayReg_o (pG3P2Del),
  731. .PG3P3DelayReg_o (pG3P3Del),
  732. .PG3P123DelayReg_o (pG3P123Del),
  733. .PG3P1WidthReg_o (pG3P1Width),
  734. .PG3P2WidthReg_o (pG3P2Width),
  735. .PG3P3WidthReg_o (pG3P3Width),
  736. .PG3P123WidthReg_o (pG3P123Width),
  737. //PG4 Regs
  738. .PG4P1DelayReg_o (pG4P1Del),
  739. .PG4P2DelayReg_o (pG4P2Del),
  740. .PG4P3DelayReg_o (pG4P3Del),
  741. .PG4P123DelayReg_o (pG4P123Del),
  742. .PG4P1WidthReg_o (pG4P1Width),
  743. .PG4P2WidthReg_o (pG4P2Width),
  744. .PG4P3WidthReg_o (pG4P3Width),
  745. .PG4P123WidthReg_o (pG4P123Width),
  746. //PG5 Regs
  747. .PG5P1DelayReg_o (pG5P1Del),
  748. .PG5P2DelayReg_o (pG5P2Del),
  749. .PG5P3DelayReg_o (pG5P3Del),
  750. .PG5P123DelayReg_o (pG5P123Del),
  751. .PG5P1WidthReg_o (pG5P1Width),
  752. .PG5P2WidthReg_o (pG5P2Width),
  753. .PG5P3WidthReg_o (pG5P3Width),
  754. .PG5P123WidthReg_o (pG5P123Width),
  755. //PG6 Regs
  756. .PG6P1DelayReg_o (pG6P1Del),
  757. .PG6P2DelayReg_o (pG6P2Del),
  758. .PG6P3DelayReg_o (pG6P3Del),
  759. .PG6P123DelayReg_o (pG6P123Del),
  760. .PG6P1WidthReg_o (pG6P1Width),
  761. .PG6P2WidthReg_o (pG6P2Width),
  762. .PG6P3WidthReg_o (pG6P3Width),
  763. .PG6P123WidthReg_o (pG6P123Width),
  764. //PG7 Regs
  765. .PG7P1DelayReg_o (pG7P1Del),
  766. .PG7P2DelayReg_o (pG7P2Del),
  767. .PG7P3DelayReg_o (pG7P3Del),
  768. .PG7P123DelayReg_o (pG7P123Del),
  769. .PG7P1WidthReg_o (pG7P1Width),
  770. .PG7P2WidthReg_o (pG7P2Width),
  771. .PG7P3WidthReg_o (pG7P3Width),
  772. .PG7P123WidthReg_o (pG7P123Width),
  773. .MeasNum1Reg_o (measNum1),
  774. .MeasNum2Reg_o (measNum2),
  775. .PgMode0Reg_o (pgMode0),
  776. .PgMode1Reg_o (pgMode1),
  777. .MuxCtrl1Reg_o (muxCtrl1),
  778. .MuxCtrl2Reg_o (muxCtrl2),
  779. .MuxCtrl3Reg_o (muxCtrl3),
  780. .MuxCtrl4Reg_o (muxCtrl4)
  781. );
  782. //--------------------------------------------------------------------------------
  783. // Global FPGA reset generator
  784. //--------------------------------------------------------------------------------
  785. InitRst FpgaInitRst
  786. (
  787. .clk_i (gclk),
  788. .signal_o (initRst)
  789. );
  790. //--------------------------------------------------------------------------------
  791. // ADC overload detection
  792. //--------------------------------------------------------------------------------
  793. genvar i;
  794. generate
  795. for (i=0; i<ChNum; i=i+1) begin :OverControl
  796. OverloadDetect
  797. #(
  798. .ThresholdWidth (ThresholdWidth),
  799. .AdcDataWidth (AdcDataWidth),
  800. .MeasPeriod (MeasPeriod)
  801. )
  802. OverloadDetect
  803. (
  804. .Rst_i (initRst),
  805. .Clk_i (gclk),
  806. .AdcData_i (adcDataBus[i]),
  807. .OverThreshold_i (overThresh),
  808. .Overload_o (overCtrlChannels[i])
  809. );
  810. end
  811. endgenerate
  812. //--------------------------------------------------------------------------------
  813. // Gain Control module
  814. //--------------------------------------------------------------------------------
  815. genvar g;
  816. generate
  817. for (g=0; g<ChNum; g=g+1) begin :GainControl
  818. GainControlWrapper
  819. #(
  820. .AdcDataWidth (AdcDataWidth),
  821. .ThresholdWidth (ThresholdWidth),
  822. .PhIncWidth (PhIncWidth),
  823. .IfNcoOutWidth (NcoWidth),
  824. .MeasPeriod (MeasPeriod)
  825. )
  826. GainControlModule
  827. (
  828. .Rst_i (initRst),
  829. .Clk_i (gclk),
  830. .StartMeas_i (sampleStrobe),
  831. .NcoSin_i (ncoSin),
  832. .NcoCos_i (ncoCos),
  833. .AdcData_i (adcDataBus[g]),
  834. // .AdcData_i (AdcData_i),
  835. .GainLowThreshold_i (gainLowThresholdBus[g]),
  836. .GainHighThreshold_i(gainHighThresholdBus[g]),
  837. .GainAutoEn_i (gainAutoEn[g]),
  838. .GainManualState_i (gainManual[g]),
  839. .AmpEnNewState_o (ampEnNewStates[g]),
  840. .SensEn_o (sensEn[g]),
  841. .MeasStart_o (measStartBus[g])
  842. );
  843. end
  844. endgenerate
  845. always @(*) begin
  846. if (!initRst) begin
  847. case(gainAutoEn)
  848. 4'd0: begin
  849. measStart = &measStartBus;
  850. end
  851. 4'd1: begin
  852. measStart = measStartBus[0];
  853. end
  854. 4'd2: begin
  855. measStart = measStartBus[1];
  856. end
  857. 4'd3: begin
  858. measStart = measStartBus[0]&measStartBus[1];
  859. end
  860. 4'd4: begin
  861. measStart = &measStartBus[2];
  862. end
  863. 4'd5: begin
  864. measStart = measStartBus[0]&measStartBus[2];
  865. end
  866. 4'd6: begin
  867. measStart = measStartBus[1]&measStartBus[2];
  868. end
  869. 4'd7: begin
  870. measStart = measStartBus[0]&measStartBus[1]&measStartBus[2];
  871. end
  872. 4'd8: begin
  873. measStart = measStartBus[3];
  874. end
  875. 4'd9: begin
  876. measStart = measStartBus[0]&measStartBus[3];
  877. end
  878. 4'd10: begin
  879. measStart = measStartBus[1]&measStartBus[3];
  880. end
  881. 4'd11: begin
  882. measStart = measStartBus[0]&measStartBus[1]&measStartBus[3];
  883. end
  884. 4'd12: begin
  885. measStart = measStartBus[2]&measStartBus[3];
  886. end
  887. 4'd13: begin
  888. measStart = measStartBus[0]&measStartBus[2]&measStartBus[3];
  889. end
  890. 4'd14: begin
  891. measStart = measStartBus[1]&measStartBus[2]&measStartBus[3];
  892. end
  893. 4'd15: begin
  894. measStart = &measStartBus;
  895. end
  896. endcase
  897. end
  898. end
  899. //--------------------------------------------------------------------------------
  900. // Dither Gen
  901. //--------------------------------------------------------------------------------
  902. DitherGenv2 DitherGenInst
  903. (
  904. .Rst_i (initRst),
  905. .Clk_i (gclk),
  906. .DitherCmd_i (ditherCtrl),
  907. .DitherCtrlT2R2_o (DitherCtrlCh1_o),
  908. .DitherCtrlT1R1_o (DitherCtrlCh2_o)
  909. );
  910. //--------------------------------------------------------------------------------
  911. // Pulse Meas modules
  912. //--------------------------------------------------------------------------------
  913. //--------------------------------------------------------------------------------
  914. // Pulse Gens
  915. //--------------------------------------------------------------------------------
  916. PGenRstGenerator PGenRstGen
  917. (
  918. .Rst_i (initRst),
  919. .Clk_i (gclk),
  920. .PGenRst_i (pgRstArray),
  921. .PGenRst_o (pGenRst),
  922. .RstDone_o (pGenRstDone)
  923. );
  924. genvar j;
  925. generate
  926. for (j=0; j<PGenNum; j=j+1) begin :PGen
  927. Mux
  928. #(
  929. .CmdRegWidth (CmdRegWidth),
  930. .PGenNum (PGenNum),
  931. .TrigPortsNum (TrigPortsNum)
  932. )
  933. PulseGenMux
  934. (
  935. .Rst_i (initRst),
  936. .MuxCtrl_i (pgMuxCtrlArray[j]),
  937. .DspTrigOut_i (1'b0),
  938. .DspStartCmd_i (1'b0),
  939. .IntTrig_i (intTrig1),
  940. .IntTrig2_i (intTrig2),
  941. .PulseBus_i (pulseBus),
  942. .ExtPortsBus_i (Trig6to1_io),
  943. .MuxOut_o (pgMuxedOut[j])
  944. );
  945. PulseGen
  946. #(
  947. .CmdRegWidth (CmdRegWidth)
  948. )
  949. PulseGenerator
  950. (
  951. .Rst_i (initRst|pGenRst[j]|pGenMeasRst[j]),
  952. .Clk_i (gclk),
  953. .EnPulse_i (pgMuxedOut[j]),
  954. .PulsePol_i (pgPulsePolArray[j]),
  955. .EnEdge_i (pgEnEdgeArray[j]),
  956. .Mode_i (pgModeArray[j]),
  957. .P1Del_i (pgP1DelArray[j]),
  958. .P2Del_i (pgP2DelArray[j]),
  959. .P3Del_i (pgP3DelArray[j]),
  960. .P1Width_i (pgP1WidthArray[j]),
  961. .P2Width_i (pgP2WidthArray[j]),
  962. .P3Width_i (pgP3WidthArray[j]),
  963. .Pulse_o (pulseBus[j])
  964. );
  965. end
  966. endgenerate
  967. //--------------------------------------------------------------------------------
  968. // Software Gating
  969. //--------------------------------------------------------------------------------
  970. Mux
  971. #(
  972. .CmdRegWidth (CmdRegWidth),
  973. .PGenNum (PGenNum),
  974. .TrigPortsNum (TrigPortsNum)
  975. )
  976. GatingMux
  977. (
  978. .Rst_i (initRst),
  979. .MuxCtrl_i (muxCtrl3[19:15]),
  980. .DspTrigOut_i (1'b0),
  981. .DspStartCmd_i (1'b0),
  982. .IntTrig_i (1'b0),
  983. .IntTrig2_i (1'b0),
  984. .PulseBus_i (pulseBus),
  985. .ExtPortsBus_i (),
  986. .MuxOut_o (gatingPulse)
  987. );
  988. //--------------------------------------------------------------------------------
  989. // SampleStrobeMux
  990. //--------------------------------------------------------------------------------
  991. Mux
  992. #(
  993. .CmdRegWidth (CmdRegWidth),
  994. .PGenNum (PGenNum),
  995. .TrigPortsNum (TrigPortsNum)
  996. )
  997. SampleStrobeMux
  998. (
  999. .Rst_i (initRst),
  1000. .MuxCtrl_i (muxCtrl2[4:0]),
  1001. .DspTrigOut_i (1'b0),
  1002. .DspStartCmd_i (1'b0),
  1003. .IntTrig_i (intTrig1),
  1004. .IntTrig2_i (1'b0),
  1005. .PulseBus_i (pulseBus),
  1006. .ExtPortsBus_i (),
  1007. .MuxOut_o (sampleStrobe)
  1008. );
  1009. //--------------------------------------------------------------------------------
  1010. // SampleStrobeGenRstDemux
  1011. //--------------------------------------------------------------------------------
  1012. SampleStrobeGenRstDemux
  1013. #(
  1014. .CmdRegWidth (CmdRegWidth),
  1015. .PGenNum (PGenNum),
  1016. .TrigPortsNum (TrigPortsNum)
  1017. )
  1018. SampleStrobeGenRstDemux
  1019. (
  1020. .Rst_i (initRst),
  1021. .MuxCtrl_i (muxCtrl2[4:0]),
  1022. .GenRst_i (stopMeas),
  1023. .RstDemuxOut_o (pGenMeasRst)
  1024. );
  1025. //--------------------------------------------------------------------------------
  1026. // Debug led
  1027. //--------------------------------------------------------------------------------
  1028. always @(posedge gclk) begin
  1029. if (initRst) begin
  1030. testCnt <= 32'b0;
  1031. end else if (testCnt != TESTCNTPARAM) begin
  1032. testCnt <= testCnt+1;
  1033. end else begin
  1034. testCnt <= 32'd0;
  1035. end
  1036. end
  1037. always @(posedge gclk) begin
  1038. if (initRst) begin
  1039. ledReg <= 1'b0;
  1040. end else if ((testCnt == TESTCNTPARAM-1)) begin
  1041. ledReg <= ~ledReg;
  1042. end
  1043. end
  1044. endmodule