rpgui.py 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164
  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.numLabel = QTW.QLabel("Repeats: ")
  30. self.numEdit = QTW.QSpinBox()
  31. self.numEdit.setMaximum(1000)
  32. self.numEdit.setValue(5)
  33. self.paramLayout.addWidget(self.typeGenLabel)
  34. self.paramLayout.addWidget(self.typeGenCombo)
  35. self.paramLayout.addWidget(self.sigWidthLabel)
  36. self.paramLayout.addWidget(self.sigWidthEdit)
  37. self.paramLayout.addWidget(self.delayLabel)
  38. self.paramLayout.addWidget(self.delayEdit)
  39. self.paramLayout.addWidget(self.numLabel)
  40. self.paramLayout.addWidget(self.numEdit)
  41. self.loadLayout = QTW.QHBoxLayout()
  42. self.loadFileEdit = QTW.QLineEdit()
  43. self.loadFileButton = QTW.QToolButton()
  44. self.freqLabel = QTW.QLabel("Central freq (kHz): ")
  45. self.freqEdit = QTW.QSpinBox()
  46. self.freqEdit.setMaximum(50000)
  47. self.freqEdit.setValue(2950)
  48. self.loadButton = QTW.QPushButton("Load")
  49. self.loadLabel = QTW.QLabel("Not loaded")
  50. self.loadLayout.addWidget(self.freqLabel)
  51. self.loadLayout.addWidget(self.freqEdit)
  52. self.loadLayout.addWidget(self.loadButton)
  53. self.loadLayout.addWidget(self.loadLabel)
  54. self.loadButton.pressed.connect(self.loadFileDialog)
  55. self.mainlayout = QTW.QVBoxLayout()
  56. self.mainlayout.addLayout(self.genLayout)
  57. self.mainlayout.addLayout(self.paramLayout)
  58. self.mainlayout.addLayout(self.loadLayout)
  59. self.sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
  60. self.setLayout(self.mainlayout)
  61. def genFileDialog(self):
  62. filename, ok = QTW.QFileDialog.getSaveFileName(
  63. self,
  64. "Save a File",
  65. "",
  66. "BIN traject (*.bin)"
  67. )
  68. if filename:
  69. swidth = self.sigWidthEdit.value()
  70. delay = self.delayEdit.value()
  71. num = self.numEdit.value()
  72. sigtype = self.typeGenCombo.currentText()
  73. array = np.array([], dtype=np.int16)
  74. samples = (swidth + delay) * 2 * num
  75. if sigtype == "Rect":
  76. delaySamples = delay * 125
  77. highSamples = swidth * 125
  78. for i in range(num):
  79. for j in range(highSamples):
  80. array = np.append(array, np.int16(32700))
  81. array = np.append(array, np.int16(0))
  82. for j in range(delaySamples):
  83. array = np.append(array, np.int16(0))
  84. array = np.append(array, np.int16(0))
  85. else:
  86. return -1
  87. with open(filename, "wb") as f:
  88. data = array.tobytes()
  89. f.write(data)
  90. self.genLabel.setText("Generated")
  91. def loadFileDialog(self):
  92. filename, ok = QTW.QFileDialog.getOpenFileName(
  93. self,
  94. "Open a File",
  95. "",
  96. "BIN traject (*.bin)"
  97. )
  98. if filename:
  99. data = b''
  100. with open(filename, "rb") as f:
  101. data = f.read()
  102. alts = np.array([], dtype=np.int16)
  103. phases = np.array([], dtype=np.int16)
  104. test = np.frombuffer(data, dtype=np.int16, count=16)
  105. for i in range(len(data) // 4):
  106. alts = np.append(alts, [np.frombuffer(data, dtype=np.int16, count=1, offset=4*i)])
  107. phases = np.append(phases, [np.frombuffer(data, dtype=np.int16, count=1, offset=4*i+2)])
  108. swidth = self.sigWidthEdit.value()
  109. delay = self.delayEdit.value()
  110. freq = self.freqEdit.value()
  111. fbuf = np.array([], dtype=np.float32)
  112. tbuf = np.arange(0, (swidth + delay) * 10e-6, 8 * 10e-9)
  113. fbuf = (alts / 32767) * np.sin(freq * 10e3 * tbuf + np.pi * phases / (32767 * 2))
  114. self.sock.connect(('rp-f082cf.local', 5005))
  115. buffer = struct.pack('<BIII', 0x02, len(fbuf), 0, 1)
  116. self.sock.sendall(buffer)
  117. buffer = self.sock.recv(1024)
  118. if buffer[0] == 0x11:
  119. for i in range(0, len(fbuf), 1019):
  120. datasize = 1019
  121. if len(fbuf) - i < 1019:
  122. datasize = len(fbuf) - i
  123. buffer = struct.pack('<BI', 0x31, np.uint32(datasize)) + fbuf[i:(i+datasize)].tobytes()
  124. self.sock.sendall(buffer)
  125. buffer = self.sock.recv(1024)
  126. if buffer[0] != 0x11:
  127. return -1
  128. buffer = struct.pack('<B', 0x21)
  129. self.sock.sendall(buffer)
  130. if buffer[0] == 0x01:
  131. self.loadLabel.setText("Loaded")
  132. app = QTW.QApplication(sys.argv)
  133. window = Window()
  134. window.show()
  135. sys.exit(app.exec())