def __init__(self, vehicle_event_dispatcher, protocol_handler):
QtGui.QWidget.__init__(self)
BasePanelController.__init__(self)
self.ui = Ui_ReceiverChannelDetectionPanel()
self.ui.setupUi(self)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.ui.cancel.clicked.connect(self.cancel_RC)
self.ui.start.clicked.connect(self.start_RCsetup)
self.amount_channels = 12
self.last_RCvalue = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]
self.first_loop = 80
self.channel_order_map = [
100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100
]
self.channel_detecting = 0
self.running = False
self.channel_offset = 200
self.max_amount_channels = 12
def __init__(self, vehicle_event_dispatcher, protocol_handler):
QtGui.QWidget.__init__(self)
BasePanelController.__init__(self)
self.ui = Ui_ReceiverChannelDetectionPanel()
self.ui.setupUi(self)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.ui.cancel.clicked.connect(self.cancel_RC)
self.ui.start.clicked.connect(self.start_RCsetup)
self.amount_channels = 12
self.last_RCvalue = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]
self.first_loop = 80
self.channel_order_map = [100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100]
self.channel_detecting = 0
self.running = False
self.channel_offset = 200
self.max_amount_channels = 12
class ReceiverChannelDetectionController(QtGui.QWidget, BasePanelController):
def __init__(self, vehicle_model, protocol_handler):
QtGui.QWidget.__init__(self)
BasePanelController.__init__(self)
self._vehicle_model = vehicle_model
self._message_sender = protocol_handler
self.ui = Ui_ReceiverChannelDetectionPanel()
self.ui.setupUi(self)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.ui.cancel.clicked.connect(self.cancel_RC)
self.ui.start.clicked.connect(self.start_RCsetup)
self.amount_channels = 12
self.last_RCvalue = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]
self.first_loop = 80
self.channel_order_map = [100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100]
self.channel_detecting = 0
self.running = False
self.channel_offset = 200
self.max_amount_channels = 12
def start(self):
pass
# self.xmlSubPanel = xmlSubPanel
# self.boardConfiguration = boardConfiguration
# try:
# self.amount_channels = int(self.boardConfiguration["Receiver Nb Channels"])
# except:
# logging.warning("Can't read amount of channels from boardconfiguration!")
# self.enable_gui_attribute()
def cancel_RC(self):
self.stop_RCsetup()
def start_RCsetup(self):
if not self.running:
if (self.comm.isConnected()):
self.running = True
self.ui.start.setEnabled(False)
self.ui.cancel.setEnabled(True)
self.comm.write("t")
self.timer = QtCore.QTimer()
self.timer.timeout.connect(self.readContinuousData)
self.timer.start(50)
self.startCommThread()
def stop_RCsetup(self):
self.comm.write("x")
self.timer.stop()
self.comm.flushResponse()
self.channel_detecting = 0;
self.running = False
self.change_label(self.channel_detecting)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.first_loop = 80
self.sendMappedChannel()
def save_channel(self, channel_number):
exist = False
for i in range(0,self.amount_channels):
if int(self.channel_order_map[i]) == int(channel_number):
exist = True
if not exist:
self.channel_order_map[self.channel_detecting] = channel_number
self.channel_detecting += 1
def readContinuousData(self):
isConnected = self.comm.isConnected()
if isConnected and not self.commData.empty():
string = self.commData.get()
string_out = string.split(',')
if self.running:
if self.channel_detecting >= self.amount_channels:
self.stop_RCsetup()
else:
for i in range(0, self.amount_channels):
if int(self.first_loop) > 0:
self.first_loop -= 1
else:
self.change_label(self.channel_detecting)
if (int(string_out[i]) - int(self.last_RCvalue[i])) > self.channel_offset:
self.save_channel(i)
if (int(string_out[i]) - int(self.last_RCvalue[i])) < -self.channel_offset:
self.save_channel(i)
self.last_RCvalue[i] = string_out[i]
def change_label(self, label_number):
if self.running:
if label_number == 0:
self.ui.label.setText('Roll... Detecting')
elif label_number == 1:
self.ui.label.setText('Roll... Done')
self.ui.label_2.setText('Pitch... Detecting')
elif label_number == 2:
self.ui.label_2.setText('Pitch.. Done')
self.ui.label_3.setText('Yaw... Detecting')
elif label_number == 3:
self.ui.label_3.setText('Yaw... Done')
self.ui.label_4.setText('Throttle... Detecting')
elif label_number == 4:
self.ui.label_4.setText('Throttle... Done')
self.ui.label_5.setText('Mode... Detecting')
elif label_number == 5:
self.ui.label_5.setText('Mode.. Done')
self.ui.label_6.setText('Aux1... Detecting')
elif label_number == 6:
self.ui.label_6.setText('Aux1.. Done')
self.ui.label_7.setText('Aux2... Detecting')
elif label_number == 7:
self.ui.label_7.setText('Aux2.. Done')
self.ui.label_8.setText('Aux3... Detecting')
elif label_number == 8:
self.ui.label_8.setText('Aux3.. Done')
self.ui.label_9.setText('Aux4... Detecting')
elif label_number == 9:
self.ui.label_9.setText('Aux4.. Done')
self.ui.label_10.setText('Aux5... Detecting')
elif label_number == 10:
self.ui.label_10.setText('Aux5.. Done')
self.ui.label_11.setText('Aux6... Detecting')
elif label_number == 11:
self.ui.label_11.setText('Aux6.. Done')
self.ui.label_12.setText('Aux7... Detecting')
elif label_number == 12:
self.ui.label_12.setText('Aux7.. Done')
else:
self.ui.label.setText('Roll')
self.ui.label_2.setText('Pitch')
self.ui.label_3.setText('Yaw')
self.ui.label_4.setText('Throttle')
self.ui.label_5.setText('Mode')
self.ui.label_6.setText('Aux1')
self.ui.label_7.setText('Aux2')
self.ui.label_8.setText('Aux3')
self.ui.label_9.setText('Aux4')
self.ui.label_10.setText('Aux5')
self.ui.label_11.setText('Aux6')
self.ui.label_12.setText('Aux7')
def enable_gui_attribute(self):
for i in range(0, self.max_amount_channels):
if i > (self.amount_channels - 1) and i == 5:
self.ui.label_6.setHidden(True)
elif i > (self.amount_channels - 1) and i == 6:
self.ui.label_7.setHidden(True)
elif i > (self.amount_channels - 1) and i == 7:
self.ui.label_8.setHidden(True)
elif i > (self.amount_channels - 1) and i == 8:
self.ui.label_9.setHidden(True)
elif i > (self.amount_channels - 1) and i == 9:
self.ui.label_10.setHidden(True)
elif i > (self.amount_channels - 1) and i == 10:
self.ui.label_11.setHidden(True)
elif i > (self.amount_channels - 1) and i == 11:
self.ui.label_12.setHidden(True)
def sendMappedChannel(self):
self.comm.write("X");
command = "R "
for i in range(0, self.amount_channels):
command += str(self.channel_order_map[i])
command += ";"
self.comm.write(command)
class ReceiverChannelDetectionController(QtGui.QWidget, BasePanelController):
def __init__(self, vehicle_event_dispatcher, protocol_handler):
QtGui.QWidget.__init__(self)
BasePanelController.__init__(self)
self.ui = Ui_ReceiverChannelDetectionPanel()
self.ui.setupUi(self)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.ui.cancel.clicked.connect(self.cancel_RC)
self.ui.start.clicked.connect(self.start_RCsetup)
self.amount_channels = 12
self.last_RCvalue = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]
self.first_loop = 80
self.channel_order_map = [
100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100
]
self.channel_detecting = 0
self.running = False
self.channel_offset = 200
self.max_amount_channels = 12
def start(self):
pass
# self.xmlSubPanel = xmlSubPanel
# self.boardConfiguration = boardConfiguration
# try:
# self.amount_channels = int(self.boardConfiguration["Receiver Nb Channels"])
# except:
# logging.warning("Can't read amount of channels from boardconfiguration!")
# self.enable_gui_attribute()
def cancel_RC(self):
self.stop_RCsetup()
def start_RCsetup(self):
if not self.running:
if (self._communicator.isConnected()):
self.running = True
self.ui.start.setEnabled(False)
self.ui.cancel.setEnabled(True)
self._communicator.write("t")
self.timer = QtCore.QTimer()
self.timer.timeout.connect(self.readContinuousData)
self.timer.start(50)
self.startCommThread()
def stop_RCsetup(self):
self._communicator.write("x")
self.timer.stop()
self._communicator.flushResponse()
self.channel_detecting = 0
self.running = False
self.change_label(self.channel_detecting)
self.ui.start.setEnabled(True)
self.ui.cancel.setEnabled(False)
self.first_loop = 80
self.sendMappedChannel()
def save_channel(self, channel_number):
exist = False
for i in range(0, self.amount_channels):
if int(self.channel_order_map[i]) == int(channel_number):
exist = True
if not exist:
self.channel_order_map[self.channel_detecting] = channel_number
self.channel_detecting += 1
def readContinuousData(self):
isConnected = self._communicator.isConnected()
if isConnected and not self.commData.empty():
string = self.commData.get()
string_out = string.split(',')
if self.running:
if self.channel_detecting >= self.amount_channels:
self.stop_RCsetup()
else:
for i in range(0, self.amount_channels):
if int(self.first_loop) > 0:
self.first_loop -= 1
else:
self.change_label(self.channel_detecting)
if (int(string_out[i]) - int(self.last_RCvalue[i])
) > self.channel_offset:
self.save_channel(i)
if (int(string_out[i]) - int(self.last_RCvalue[i])
) < -self.channel_offset:
self.save_channel(i)
self.last_RCvalue[i] = string_out[i]
def change_label(self, label_number):
if self.running:
if label_number == 0:
self.ui.label.setText('Roll... Detecting')
elif label_number == 1:
self.ui.label.setText('Roll... Done')
self.ui.label_2.setText('Pitch... Detecting')
elif label_number == 2:
self.ui.label_2.setText('Pitch.. Done')
self.ui.label_3.setText('Yaw... Detecting')
elif label_number == 3:
self.ui.label_3.setText('Yaw... Done')
self.ui.label_4.setText('Throttle... Detecting')
elif label_number == 4:
self.ui.label_4.setText('Throttle... Done')
self.ui.label_5.setText('Mode... Detecting')
elif label_number == 5:
self.ui.label_5.setText('Mode.. Done')
self.ui.label_6.setText('Aux1... Detecting')
elif label_number == 6:
self.ui.label_6.setText('Aux1.. Done')
self.ui.label_7.setText('Aux2... Detecting')
elif label_number == 7:
self.ui.label_7.setText('Aux2.. Done')
self.ui.label_8.setText('Aux3... Detecting')
elif label_number == 8:
self.ui.label_8.setText('Aux3.. Done')
self.ui.label_9.setText('Aux4... Detecting')
elif label_number == 9:
self.ui.label_9.setText('Aux4.. Done')
self.ui.label_10.setText('Aux5... Detecting')
elif label_number == 10:
self.ui.label_10.setText('Aux5.. Done')
self.ui.label_11.setText('Aux6... Detecting')
elif label_number == 11:
self.ui.label_11.setText('Aux6.. Done')
self.ui.label_12.setText('Aux7... Detecting')
elif label_number == 12:
self.ui.label_12.setText('Aux7.. Done')
else:
self.ui.label.setText('Roll')
self.ui.label_2.setText('Pitch')
self.ui.label_3.setText('Yaw')
self.ui.label_4.setText('Throttle')
self.ui.label_5.setText('Mode')
self.ui.label_6.setText('Aux1')
self.ui.label_7.setText('Aux2')
self.ui.label_8.setText('Aux3')
self.ui.label_9.setText('Aux4')
self.ui.label_10.setText('Aux5')
self.ui.label_11.setText('Aux6')
self.ui.label_12.setText('Aux7')
def enable_gui_attribute(self):
for i in range(0, self.max_amount_channels):
if i > (self.amount_channels - 1) and i == 5:
self.ui.label_6.setHidden(True)
elif i > (self.amount_channels - 1) and i == 6:
self.ui.label_7.setHidden(True)
elif i > (self.amount_channels - 1) and i == 7:
self.ui.label_8.setHidden(True)
elif i > (self.amount_channels - 1) and i == 8:
self.ui.label_9.setHidden(True)
elif i > (self.amount_channels - 1) and i == 9:
self.ui.label_10.setHidden(True)
elif i > (self.amount_channels - 1) and i == 10:
self.ui.label_11.setHidden(True)
elif i > (self.amount_channels - 1) and i == 11:
self.ui.label_12.setHidden(True)
def sendMappedChannel(self):
self._communicator.write("X")
command = "R "
for i in range(0, self.amount_channels):
command += str(self.channel_order_map[i])
command += ";"
self._communicator.write(command)
