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
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
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.UI;
const Int32 x_ABS_POS = 0x01;
const Int32 x_EL_POS = 0x02;
const Int32 x_MARK = 0x03;
const Int32 x_SPEED = 0x04;
const Int32 x_ACC = 0x05;
const Int32 x_DEC = 0x06;
const Int32 x_MAX_SPEED = 0x07;
const Int32 x_MIN_SPEED = 0x08;
const Int32 x_FS_SPD = 0x15;
const Int32 x_KVAL_HOLD = 0x09;
const Int32 x_KVAL_RUN = 0x0A;
const Int32 x_KVAL_ACC = 0x0B;
const Int32 x_KVAL_DEC = 0x0C;
const Int32 x_INT_SPD = 0x0D;
const Int32 x_ST_SLP = 0x0E;
const Int32 x_FN_SLP_ACC = 0x0F;
const Int32 x_FN_SLP_DEC = 0x10;
const Int32 x_K_THERM = 0x11;
const Int32 x_ADC_OUT = 0x12;
const Int32 x_OCD_TH = 0x13;
const Int32 x_STALL_TH = 0x14;
const Int32 x_STEP_MODE = 0x16;
const Int32 x_ALARM_EN = 0x17;
const Int32 x_CONFIG = 0x18;
const Int32 x_STATUS = 0x19;
//-------------------------------
const Int32 x_GET_PARAM = 0x20;
//-------------------------------
const Int32 Max_Motor_ID = 25;
Int32 i = 12;
public void OnExecute(StubManager stubManager)
{
//for (i = 0; i < Max_Motor_ID; i++)
{
stubManager.Write("\nMoTor ");
stubManager.WriteHex(i,2);
stubManager.Write("\n-------------------------\n");
var response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_MIN_SPEED)<<16, 0, 0);
stubManager.Write("x_MIN_SPEED : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_MAX_SPEED)<<16, 0, 0);
stubManager.Write("x_MAX_SPEED : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_STEP_MODE)<<8, 0, 0);
stubManager.Write("x_STEP_MODE : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_ACC)<<16, 0, 0);
stubManager.Write("x_ACC : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_DEC)<<16, 0, 0);
stubManager.Write("x_DEC : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_KVAL_HOLD)<<8, 0, 0);
stubManager.Write("x_KVAL_HOLD : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_KVAL_RUN)<<8, 0, 0);
stubManager.Write("x_KVAL_RUN : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_KVAL_ACC)<<8, 0, 0);
stubManager.Write("x_KVAL_ACC : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_KVAL_DEC)<<8, 0, 0);
stubManager.Write("x_KVAL_DEC : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_OCD_TH)<<8, 0, 0);
stubManager.Write("x_OCD_TH : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_STALL_TH)<<8, 0, 0);
stubManager.Write("x_STALL_TH : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_CONFIG)<<16, 0, 0);
stubManager.Write("x_CONFIG : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
response = stubManager.Run<StubMotorResponse>("StubMotorRequest" ,i, (x_GET_PARAM | x_FS_SPD)<<16, 0, 0);
stubManager.Write("x_FS_SPD : ");
stubManager.WriteHex(response.RecivedData,4);
stubManager.Write("\n\n");
}
}
|
