aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Stubs Collection/stubs/Scripts/Assemblies/RTFU/RTFU_SSI.cs
blob: c62140767f9f8507b380650d89986e334ce967bd (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
using System;
using System.Text;
using System.Linq;
using System.Drawing;
using System.Diagnostics;
using System.Windows.Forms;
using System.Threading;
using System.Threading.Tasks;
using System.Collections.Generic;
using Tango.PMR.Stubs;
using Tango.Stubs;

include "..\..\Defines\Tango_Defines_Basic.cs"
include "Tango_Defines_SSI.cs"
//include "C:\To_Backup\Mulberry\Mulberry_current\Customers\Twine\Tango\LAB_Tests\Main_PCB\ATP_Test\Scripts\Defines\Tango_Defines_Basic.cs"
//include "C:\To_Backup\Mulberry\Mulberry_current\Customers\Twine\Tango\LAB_Tests\Main_PCB\ATP_Test\Scripts\Defines\Tango_Defines_SSI.cs"

public void OnExecute(StubManager stubManager)
{
	
	int k = 0;
	
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg1,0 );
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg2,0 );	
	
	//Set output clock frequency to about 200 kHz
	Fpga_Write_Reg(FPGA1, F1_Prescaler1_reg1, 0x0024, 0);
	Fpga_Write_Reg(FPGA1, F1_Prescaler1_reg2, 0x0024, 0);
	
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg1, 0);
	Fpga_Read_Reg(FPGA1, F1_Prescaler1_reg2, 0);

	for (int i = 0; i < 100; i++)
	{
	

		SSI_Read_Write(FPGA1, F1_RDANCER_ROTENC_MSB, F1_RDANCER_ROTENC_LSB, F1_RDANCER_ROTENC_TX);
		SSI_Read_Write(FPGA1, F1_RSPARE_ROTENC_MSB, F1_RSPARE_ROTENC_LSB, F1_RSPARE_ROTENC_TX);
		stubManager.Write("\n");
		k++;
		if  ( (k & 0x8) == 0x08 ) {
			k = 0;			
			stubManager.Write("	RDANCER    					RSpeed      \n");
		}
		Thread.Sleep(400);
	}
	
	
}