-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathDCM130.py
executable file
·161 lines (120 loc) · 4.83 KB
/
DCM130.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
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
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
#!/usr/bin/env python3
import ctypes
import enum
import logging
import sys
import time
from typing import List, Optional
import usb1
def _error(msg: str, code: int = 1) -> None:
'''
Prints an error message and exits. Will color the output when writting to a TTY.
:param msg: Error message
:param code: Error code
'''
prefix = 'ERROR'
if sys.stdout.isatty():
prefix = '\33[91m' + prefix + '\33[0m'
print('{} {}'.format(prefix, msg))
exit(code)
class _Request(enum.Enum):
CONTROL = 1
REG_READ = 10
REG_WRITE = 11
class _Registers(enum.Enum):
SIZE_X = 0x0022
SIZE_Y = 0x0023
class ScopetekDevice():
def __init__(self, device: usb1.USBDeviceHandle) -> None:
self.__logger = logging.getLogger(self.__class__.__name__)
self._dev = device
def start(self) -> None:
self.request(_Request.CONTROL, 0x000f, 0x0001)
self.request(_Request.CONTROL, 0x000f, 0x0000) # stop
self.request(_Request.CONTROL, 0x000f, 0x0001)
self.request(_Request.REG_READ, 0x0000, 0x0000, size=3)
self.request(_Request.REG_WRITE, 0x000a, 0x8000)
self.request(_Request.REG_WRITE, 0x000d, 0x0001)
time.sleep(0.1)
self.request(_Request.REG_WRITE, 0x000d, 0x0000)
time.sleep(0.1)
self.request(_Request.REG_WRITE, 0x0001, 0x0015) # X?
self.request(_Request.REG_WRITE, 0x0002, 0x0021) # Y?
time.sleep(0.2)
self.request(_Request.REG_WRITE, 0x0020, 0x0000)
self.request(_Request.REG_WRITE, 0x001e, 0x8040)
self.request(_Request.REG_WRITE, 0x004e, 0x0030)
self.request(_Request.REG_WRITE, 0x0004, 0x07ff) # X?
self.request(_Request.REG_WRITE, 0x0003, 0x05ff) # Y?
self.request(_Request.REG_WRITE, 0x002b, 0x0060)
self.request(_Request.REG_WRITE, 0x002c, 0x0060)
self.request(_Request.REG_WRITE, 0x002d, 0x0060)
self.request(_Request.REG_WRITE, 0x002e, 0x0060)
self.request(_Request.REG_WRITE, 0x000a, 0x8001)
# resolution?
self.request(_Request.REG_WRITE, 0x0022, 0x0033) # X?
self.request(_Request.REG_WRITE, 0x0023, 0x0033) # Y?
self.request(_Request.REG_WRITE, 0x0005, 0x0150)
self.request(_Request.REG_WRITE, 0x000a, 0x8000)
self.request(_Request.REG_WRITE, 0x0005, 0x0300)
self.request(_Request.REG_READ, 0x0005, 0x0000, size=3)
self.request(_Request.REG_READ, 0x0004, 0x0000, size=3)
self.request(_Request.REG_READ, 0x0002, 0x0000, size=3)
self.request(_Request.REG_WRITE, 0x0009, 0x012c)
time.sleep(0.2)
self.request(_Request.REG_WRITE, 0x0035, 0x0056)
self.request(_Request.CONTROL, 0x000f, 0x0003)
def stop(self) -> None:
self.request(_Request.CONTROL, 0x000f, 0x0000)
def request(self, request: _Request, index: int, value: int, *,
data: Optional[List[int]] = None, size: Optional[int] = None,
timeout: int = 0) -> Optional[List[int]]:
if request == _Request.CONTROL:
request_type = 0x40 # host to dev, vendor, dev
size = 0
elif request == _Request.REG_READ or request == _Request.REG_WRITE:
request_type = 0xc0 # dev to host, vendor, dev
if size is None:
size = 1
else:
raise TypeError('Unknown request')
# https://github.com/python/mypy/issues/9264
buffer = bytearray(data if data else size) # type: ignore
if data:
self.__logger.debug('write(0x{:04x}, 0x{:04x}) {}'.format(
index, value, ''.join(f'{byte:02x}' for byte in data)
))
else:
self.__logger.debug(f' send(0x{index:04x}, 0x{value:04x})')
# https://github.com/vpelletier/python-libusb1/issues/56
buffer, _ = usb1.create_initialised_buffer(buffer)
self._dev._controlTransfer(
request_type,
request.value,
value,
index,
buffer,
ctypes.sizeof(buffer),
timeout
)
time.sleep(0.002)
if buffer:
data = [int.from_bytes(byte, byteorder='big') for byte in buffer]
self.__logger.debug(' read(0x{:04x}, 0x{:04x}) {}'.format(
index, value, ''.join(f'{byte:02x}' for byte in data)
))
if data[-1] != 0x08:
raise RuntimeError(f'Received error from the device: {data[-1]}')
return data
return None
def main() -> None:
ctx = usb1.LibUSBContext()
usb_dev = ctx.openByVendorIDAndProductID(0x0547, 0x4d33)
if not usb_dev:
_error('Device not found (0x0547, 0x4d33)')
dev = ScopetekDevice(usb_dev)
dev.start()
if __name__ == '__main__':
if '--debug' in sys.argv[1:]:
logging.basicConfig(level=logging.DEBUG)
main()