-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathlac2.py
84 lines (73 loc) · 2.68 KB
/
lac2.py
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
from ctypes import *
mydll = cdll.LoadLibrary("C:\Users\LokoKoko\Desktop\LAC\mpusbapi.dll")
deviceVID_PID = "vid_04d8&pid_fc5f"
ACTUATORPOSValue = c_uint16(0)
# ACTUATORSPDValue = 1023, ACTUATORextendstallValue = 10, ACTUATORControl_maxValue = 1023,
# ACTUATORPos_ThresholdValue = 4,
# ACTUATORMovement_ThresholdValue = 3,
# ACTUATORControl_minValue = 0,
# ACTUATORStall_timeValue = 10000,
# ACTUATORPWM_ThresholdValue = 80,
# ACTUATORAverage_adcValue = 8,
# ACTUATORKpValue = 1,
# ACTUATORAverage_RCValue = 4,
# ACTUATORPWM_maxValue = 1023,
# ACTUATORKdValue = 10,
# ACTUATORPWM_minValue = 80,
# ACTUATORDerivative_maxValue = 1023,
# ACTUATORDerivative_minValue = 0)
# print hm
AttachedState = c_bool(False)
# ACTUATORPOSFlag = False, ACTUATORSPDFlag = False, ACTUATORControl_maxFlag = False,
# ACTUATORPos_ThresholdFlag = False,
# ACTUATORMovement_ThresholdFlag = False,
# ACTUATORControl_minFlag = False,
# ACTUATORPWM_ThresholdFlag = False,
# ACTUATORAverage_adcFlag = False,
# ACTUATORKpFlag = False,
# ACTUATORextendstallFlag = False,
# ACTUATORAverage_RCFlag = False,
# ACTUATORPWM_maxFlag = False,
# ACTUATORKdFlag = False,
# ACTUATORPWM_minFlag=False,
# ACTUATORDerivative_maxFlag = False,
# ACTUATORDerivative_ThresholdFlag = False,
# ACTUATORDerivative_minFlag = False,
# buttonResetFlag = False,
# buttonSave_ConfigFlag = False,
# button_cycletestFlag = False,
# buttonEnable_RC_ProgFlag = False,
# buttonDisable_RC_ProgFlag = False)
# #####----- Initial Start up -------#######
if mydll._MPUSBGetDeviceCount(deviceVID_PID) == 1:
EP1OUTHandle = mydll._MPUSBOpen(0, deviceVID_PID, "\MCHP_EP1", 0, 0);
EP1INHandle = mydll._MPUSBOpen(0, deviceVID_PID, "\MCHP_EP1", 1, 0);
AttachedState = True
bufferVar = create_string_buffer(64)
actualLength = 0
c_ulong(actualLength)
tempPos = c_uint16(100)
while(True):
ACTUATORPOSFlag = True
if ACTUATORPOSFlag == True:
tempPos = ACTUATORPOSValue
bufferVar[0] = '\x20'
bufferVar[1] = '\x01'
bufferVar[2] = '\x03'
if AttachedState == True:
if mydll._MPUSBWrite(EP1OUTHandle, bufferVar, 3, actualLength, 1000) == 1:
if mydll._MPUSBRead(EP1INHandle, bufferVar, 3, actualLength, 1000) == 1:
print bufferVar[1]
# nelem = 1
# actualLength = 0
# c_ulong(actualLength)
# print sizeof(Buf) , repr(Buf.raw)
# value = 0
# Buf[0] = '\x20'
# Buf[1] = c_char('\x00')
# Buf[2] = c_char('\x00')
#
#
# mydll._MPUSBRead(devIn,Buf, 3, actualLength)
#
#