rpgui.py 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188
  1. import PySide6.QtWidgets as QTW
  2. import numpy as np
  3. import struct
  4. import socket
  5. import sys
  6. class Window(QTW.QWidget):
  7. def __init__(self):
  8. super().__init__()
  9. self.genLayout = QTW.QHBoxLayout()
  10. self.genButton = QTW.QPushButton("Generate")
  11. self.genButton.pressed.connect(self.genFileDialog)
  12. self.genLabel = QTW.QLabel("Not generated")
  13. self.genLayout.addWidget(self.genButton)
  14. self.genLayout.addWidget(self.genLabel)
  15. self.paramLayout = QTW.QHBoxLayout()
  16. self.typeGenLabel = QTW.QLabel("Type: ")
  17. self.typeGenCombo = QTW.QComboBox()
  18. self.typeGenCombo.addItem("Rect")
  19. self.typeGenCombo.addItem("Sinc")
  20. self.typeGenCombo.addItem("Triangle")
  21. self.sigWidthLabel = QTW.QLabel("Width (us): ")
  22. self.sigWidthEdit = QTW.QSpinBox()
  23. self.sigWidthEdit.setMaximum(1000000)
  24. self.sigWidthEdit.setValue(1000)
  25. self.delayLabel = QTW.QLabel("Delay (us): ")
  26. self.delayEdit = QTW.QSpinBox()
  27. self.delayEdit.setMaximum(1000000)
  28. self.delayEdit.setValue(500)
  29. self.frontsLabel = QTW.QLabel("Fronts (us): ")
  30. self.frontsEdit = QTW.QSpinBox()
  31. self.frontsEdit.setMaximum(100)
  32. self.frontsEdit.setValue(2)
  33. self.numLabel = QTW.QLabel("Repeats: ")
  34. self.numEdit = QTW.QSpinBox()
  35. self.numEdit.setMaximum(1000)
  36. self.numEdit.setValue(5)
  37. self.paramLayout.addWidget(self.typeGenLabel)
  38. self.paramLayout.addWidget(self.typeGenCombo)
  39. self.paramLayout.addWidget(self.sigWidthLabel)
  40. self.paramLayout.addWidget(self.sigWidthEdit)
  41. self.paramLayout.addWidget(self.delayLabel)
  42. self.paramLayout.addWidget(self.delayEdit)
  43. self.paramLayout.addWidget(self.frontsLabel)
  44. self.paramLayout.addWidget(self.frontsEdit)
  45. self.paramLayout.addWidget(self.numLabel)
  46. self.paramLayout.addWidget(self.numEdit)
  47. self.loadLayout = QTW.QHBoxLayout()
  48. self.loadFileEdit = QTW.QLineEdit()
  49. self.loadFileButton = QTW.QToolButton()
  50. self.freqLabel = QTW.QLabel("Central freq (kHz): ")
  51. self.freqEdit = QTW.QSpinBox()
  52. self.freqEdit.setMaximum(50000)
  53. self.freqEdit.setValue(2950)
  54. self.loadButton = QTW.QPushButton("Load")
  55. self.loadLabel = QTW.QLabel("Not loaded")
  56. self.loadLayout.addWidget(self.freqLabel)
  57. self.loadLayout.addWidget(self.freqEdit)
  58. self.loadLayout.addWidget(self.loadButton)
  59. self.loadLayout.addWidget(self.loadLabel)
  60. self.loadButton.pressed.connect(self.loadFileDialog)
  61. self.mainlayout = QTW.QVBoxLayout()
  62. self.mainlayout.addLayout(self.genLayout)
  63. self.mainlayout.addLayout(self.paramLayout)
  64. self.mainlayout.addLayout(self.loadLayout)
  65. self.sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
  66. self.setLayout(self.mainlayout)
  67. def genFileDialog(self):
  68. filename, ok = QTW.QFileDialog.getSaveFileName(
  69. self,
  70. "Save a File",
  71. "",
  72. "BIN traject (*.bin)"
  73. )
  74. if filename:
  75. swidth = self.sigWidthEdit.value()
  76. delay = self.delayEdit.value()
  77. fronts = self.frontsEdit.value()
  78. num = self.numEdit.value()
  79. sigtype = self.typeGenCombo.currentText()
  80. array = np.array([], dtype=np.int16)
  81. samples = (swidth + delay) * 2 * num
  82. if sigtype == "Rect":
  83. delaySamples = delay * 125
  84. highSamples = swidth * 125
  85. frontSamples = fronts * 125
  86. for i in range(num):
  87. for j in range(frontSamples):
  88. array = np.append(array, np.int16(32700 * j // frontSamples))
  89. array = np.append(array, np.int16(0))
  90. for j in range(highSamples):
  91. array = np.append(array, np.int16(32700))
  92. array = np.append(array, np.int16(0))
  93. for j in range(frontSamples):
  94. array = np.append(array, np.int16(32700 - 32700 * j // frontSamples))
  95. array = np.append(array, np.int16(0))
  96. for j in range(delaySamples):
  97. array = np.append(array, np.int16(0))
  98. array = np.append(array, np.int16(0))
  99. else:
  100. return -1
  101. with open(filename, "wb") as f:
  102. data = array.tobytes()
  103. f.write(data)
  104. self.genLabel.setText("Generated")
  105. def loadFileDialog(self):
  106. filename, ok = QTW.QFileDialog.getOpenFileName(
  107. self,
  108. "Open a File",
  109. "",
  110. "BIN traject (*.bin)"
  111. )
  112. if filename:
  113. data = b''
  114. with open(filename, "rb") as f:
  115. data = f.read()
  116. alts = np.array([], dtype=np.int16)
  117. phases = np.array([], dtype=np.int16)
  118. test = np.frombuffer(data, dtype=np.int16, count=16)
  119. for i in range(len(data) // 4):
  120. alts = np.append(alts, [np.frombuffer(data, dtype=np.int16, count=1, offset=4*i)])
  121. phases = np.append(phases, [np.frombuffer(data, dtype=np.int16, count=1, offset=4*i+2)])
  122. swidth = self.sigWidthEdit.value()
  123. delay = self.delayEdit.value()
  124. fronts = self.frontsEdit.value()
  125. freq = self.freqEdit.value()
  126. print(len(alts))
  127. print(len(phases))
  128. fbuf = np.array([], dtype=np.float32)
  129. tbuf = np.arange(0, np.float32((swidth + delay + 2 * fronts) * 10e-6), np.float32(8 * 10e-9))
  130. fbuf = np.float32((alts / 32767) * np.float32(np.sin(2 * np.pi * freq * 100 * tbuf + np.pi * phases / (32767 * 2))))
  131. print(fbuf[10000:12000])
  132. self.sock.connect(('rp-f0cf82.local', 5005))
  133. buffer = struct.pack('<BIII', 0x01, (len(fbuf) // 4096 + 1) * 4096, 1, 1)
  134. self.sock.sendall(buffer)
  135. buffer = self.sock.recv(4096)
  136. if buffer[0] == 0x11:
  137. for i in range(0, len(fbuf), 509):
  138. datasize = 509
  139. if len(fbuf) - i < 509:
  140. datasize = len(fbuf) - i
  141. buffer = struct.pack('<BI', 0x11, np.uint32(datasize)) + fbuf[i:(i+datasize)].tobytes()
  142. print(np.frombuffer(fbuf[i:(i+datasize)].tobytes(), dtype=np.float32, count=1, offset=0))
  143. self.sock.sendall(buffer)
  144. buffer = self.sock.recv(4096)
  145. if buffer[0] != 0x11:
  146. self.sock.close()
  147. return -1
  148. else:
  149. self.sock.close()
  150. return -1
  151. buffer = struct.pack('<B', 0x21)
  152. self.sock.sendall(buffer)
  153. buffer = self.sock.recv(1024)
  154. if buffer[0] == 0x01:
  155. self.loadLabel.setText("Loaded")
  156. self.sock.close()
  157. app = QTW.QApplication(sys.argv)
  158. window = Window()
  159. window.show()
  160. sys.exit(app.exec())