|
| 1 | +#!/usr/bin/env python |
| 2 | +# -*- coding: utf-8 -*- |
| 3 | +from PyQt5 import QtWidgets, QtCore |
| 4 | +from PyQt5.Qt import QTreeWidget |
| 5 | + |
| 6 | +from src.gui.sharedcomnponets.sharedcomponets import GUIToolKit |
| 7 | +from src.simpleFOCConnector import SimpleFOCDevice |
| 8 | + |
| 9 | + |
| 10 | +class DeviceTreeView(QTreeWidget): |
| 11 | + def __init__(self, parent=None): |
| 12 | + super().__init__(parent) |
| 13 | + |
| 14 | + self.device = SimpleFOCDevice.getInstance() |
| 15 | + |
| 16 | + self.sFOCDevice = QtWidgets.QTreeWidgetItem(self) |
| 17 | + self.sFOCDevice.setText(0, 'sFOC Device') |
| 18 | + self.sFOCDevice.setIcon(0, GUIToolKit.getIconByName('motor')) |
| 19 | + |
| 20 | + self.pidConfiguration = QtWidgets.QTreeWidgetItem(self.sFOCDevice) |
| 21 | + self.pidConfiguration.setText(0, 'Pid configuration') |
| 22 | + self.pidConfiguration.setIcon(0, GUIToolKit.getIconByName('pidconfig')) |
| 23 | + self.sFOCDevice.addChild(self.pidConfiguration) |
| 24 | + |
| 25 | + self.proportionalGain = QtWidgets.QTreeWidgetItem(self.pidConfiguration) |
| 26 | + self.proportionalGain.setText(0, 'Proportional gain') |
| 27 | + self.proportionalGain.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 28 | + self.pidConfiguration.addChild(self.proportionalGain) |
| 29 | + self.proportionalValue = QtWidgets.QTreeWidgetItem(self.proportionalGain) |
| 30 | + self.proportionalValue.setText(0, '') |
| 31 | + self.proportionalValue.setFlags( |
| 32 | + self.proportionalValue.flags() | QtCore.Qt.ItemIsEditable) |
| 33 | + self.proportionalGain.addChild(self.proportionalValue) |
| 34 | + |
| 35 | + self.integralGain = QtWidgets.QTreeWidgetItem(self.pidConfiguration) |
| 36 | + self.integralGain.setText(0, 'Integral gain') |
| 37 | + self.integralGain.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 38 | + self.pidConfiguration.addChild(self.integralGain) |
| 39 | + self.integralGainlValue = QtWidgets.QTreeWidgetItem(self.integralGain) |
| 40 | + self.integralGainlValue.setText(0, '') |
| 41 | + self.integralGainlValue.setFlags( |
| 42 | + self.integralGainlValue.flags() | QtCore.Qt.ItemIsEditable) |
| 43 | + self.integralGain.addChild(self.integralGainlValue) |
| 44 | + |
| 45 | + self.derivativeGain = QtWidgets.QTreeWidgetItem(self.pidConfiguration) |
| 46 | + self.derivativeGain.setText(0, 'Derivative gain') |
| 47 | + self.derivativeGain.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 48 | + self.pidConfiguration.addChild(self.derivativeGain) |
| 49 | + self.derivativeGainValue = QtWidgets.QTreeWidgetItem(self.derivativeGain) |
| 50 | + self.derivativeGainValue.setText(0, '') |
| 51 | + self.derivativeGainValue.setFlags( |
| 52 | + self.derivativeGainValue.flags() | QtCore.Qt.ItemIsEditable) |
| 53 | + self.derivativeGain.addChild(self.derivativeGainValue) |
| 54 | + |
| 55 | + self.voltageRamp = QtWidgets.QTreeWidgetItem(self.pidConfiguration) |
| 56 | + self.voltageRamp.setText(0, 'Voltage Ramp') |
| 57 | + self.voltageRamp.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 58 | + self.pidConfiguration.addChild(self.voltageRamp) |
| 59 | + self.voltageRampValue = QtWidgets.QTreeWidgetItem(self.voltageRamp) |
| 60 | + self.voltageRampValue.setText(0, '') |
| 61 | + self.voltageRampValue.setFlags( |
| 62 | + self.voltageRampValue.flags() | QtCore.Qt.ItemIsEditable) |
| 63 | + self.voltageRamp.addChild(self.derivativeGainValue) |
| 64 | + |
| 65 | + self.generalStttings = QtWidgets.QTreeWidgetItem(self.sFOCDevice) |
| 66 | + self.generalStttings.setText(0, 'General settings') |
| 67 | + self.generalStttings.setIcon(0, GUIToolKit.getIconByName('generalsettings')) |
| 68 | + self.sFOCDevice.addChild(self.generalStttings) |
| 69 | + |
| 70 | + self.lwpFilter = QtWidgets.QTreeWidgetItem(self.generalStttings) |
| 71 | + self.lwpFilter.setText(0, 'Low pass filterRamp') |
| 72 | + self.lwpFilter.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 73 | + self.generalStttings.addChild(self.lwpFilter) |
| 74 | + self.lwpFilterValue = QtWidgets.QTreeWidgetItem(self.lwpFilter) |
| 75 | + self.lwpFilterValue.setText(0, '') |
| 76 | + self.lwpFilterValue.setFlags( |
| 77 | + self.lwpFilterValue.flags() | QtCore.Qt.ItemIsEditable) |
| 78 | + self.lwpFilter.addChild(self.lwpFilterValue) |
| 79 | + |
| 80 | + self.pGain = QtWidgets.QTreeWidgetItem(self.generalStttings) |
| 81 | + self.pGain.setText(0, 'Prop gain') |
| 82 | + self.pGain.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 83 | + self.generalStttings.addChild(self.pGain) |
| 84 | + self.pGainValue = QtWidgets.QTreeWidgetItem(self.pGain) |
| 85 | + self.pGainValue.setText(0, '') |
| 86 | + self.pGainValue.setFlags(self.pGainValue.flags() | QtCore.Qt.ItemIsEditable) |
| 87 | + self.pGain.addChild(self.pGainValue) |
| 88 | + |
| 89 | + self.veliLimit = QtWidgets.QTreeWidgetItem(self.generalStttings) |
| 90 | + self.veliLimit.setText(0, 'Velocity limit') |
| 91 | + self.veliLimit.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 92 | + self.generalStttings.addChild(self.veliLimit) |
| 93 | + self.veliLimitValue = QtWidgets.QTreeWidgetItem(self.veliLimit) |
| 94 | + self.veliLimitValue.setText(0, '') |
| 95 | + self.veliLimitValue.setFlags( |
| 96 | + self.veliLimitValue.flags() | QtCore.Qt.ItemIsEditable) |
| 97 | + self.veliLimit.addChild(self.veliLimitValue) |
| 98 | + |
| 99 | + self.voliLimit = QtWidgets.QTreeWidgetItem(self.generalStttings) |
| 100 | + self.voliLimit.setText(0, 'Voltage limit') |
| 101 | + self.voliLimit.setIcon(0, GUIToolKit.getIconByName('gear')) |
| 102 | + self.generalStttings.addChild(self.voliLimit) |
| 103 | + self.voliLimitValue = QtWidgets.QTreeWidgetItem(self.voliLimit) |
| 104 | + self.voliLimitValue.setText(0, '') |
| 105 | + self.voliLimitValue.setFlags( |
| 106 | + self.voliLimitValue.flags() | QtCore.Qt.ItemIsEditable) |
| 107 | + self.voliLimit.addChild(self.voliLimitValue) |
| 108 | + |
| 109 | + self.setAlternatingRowColors(True) |
| 110 | + self.header().hide() |
| 111 | + self.expandAll() |
| 112 | + |
| 113 | + self.device.addConnectionStateListener(self) |
| 114 | + self.device.commProvider.commandDataReceived.connect(self.commandResponseReceived) |
| 115 | + |
| 116 | + self.itemChanged.connect(self.sendCommand) |
| 117 | + |
| 118 | + |
| 119 | + self.proportionalValue.setText(0,str(self.device.proportionalGainPID)) |
| 120 | + self.integralGainlValue.setText(0,str(self.device.integralGainPID)) |
| 121 | + self.derivativeGainValue.setText(0,str(self.device.derivativeGainPID)) |
| 122 | + self.voltageRampValue.setText(0,str(self.device.voltageRampPID)) |
| 123 | + |
| 124 | + self.lwpFilterValue.setText(0,str(self.device.lowPassFilter)) |
| 125 | + self.pGainValue.setText(0,str(self.device.anglePGain)) |
| 126 | + self.veliLimitValue.setText(0,str(self.device.velocityLimit)) |
| 127 | + self.voliLimitValue.setText(0,str(self.device.voltageLimit)) |
| 128 | + |
| 129 | + self.setEnabled(False) |
| 130 | + |
| 131 | + def sendCommand(self, item, column): |
| 132 | + value = item.text(0) |
| 133 | + fieldName = item.parent().text(0) |
| 134 | + if 'Proportional gain' in fieldName: |
| 135 | + self.device.sendProportionalGain(value) |
| 136 | + elif 'Integral gain' in fieldName: |
| 137 | + self.device.sendIntegralGain(value) |
| 138 | + elif 'Derivative gain' in fieldName: |
| 139 | + self.device.sendDerivativeGain(value) |
| 140 | + elif 'Voltage Ramp' in fieldName: |
| 141 | + self.device.sendVoltageRamp(value) |
| 142 | + elif 'Low pass filterRamp' in fieldName: |
| 143 | + self.device.sendLowPassFilter(value) |
| 144 | + elif 'Prop gain' in fieldName: |
| 145 | + self.device.sendPGain(value) |
| 146 | + elif 'Velocity limit' in fieldName: |
| 147 | + self.device.sendVelocityLimit(value) |
| 148 | + elif 'Voltage limit' in fieldName: |
| 149 | + self.device.sendVoltageLimit(value) |
| 150 | + |
| 151 | + def commandResponseReceived(self, comandResponse): |
| 152 | + if 'PID velocity| P' in comandResponse: |
| 153 | + self.proportionalValue.setText(0,comandResponse.replace('PID velocity| P:', '')) |
| 154 | + elif 'PID velocity| I' in comandResponse: |
| 155 | + self.integralGainlValue.setText(0,comandResponse.replace('PID velocity| I:', '')) |
| 156 | + elif 'PID velocity| D' in comandResponse: |
| 157 | + self.derivativeGainValue.setText(0,comandResponse.replace('PID velocity| D:', '')) |
| 158 | + elif 'PID velocity| volt_ramp' in comandResponse: |
| 159 | + self.voltageRampValue.setText(0,comandResponse.replace('PID velocity| volt_ramp:', '')) |
| 160 | + elif 'LPF velocity| Tf:' in comandResponse: |
| 161 | + self.lwpFilterValue.setText(0, |
| 162 | + comandResponse.replace('LPF velocity| Tf:', '')) |
| 163 | + elif 'P angle| P:' in comandResponse: |
| 164 | + self.pGainValue.setText(0, |
| 165 | + comandResponse.replace('P angle| P:', '')) |
| 166 | + elif 'Limits| vel_limit:' in comandResponse: |
| 167 | + self.veliLimitValue.setText(0, |
| 168 | + comandResponse.replace('Limits| vel_limit:', '')) |
| 169 | + elif 'Limits| volt_limit:' in comandResponse: |
| 170 | + self.voliLimitValue.setText(0, |
| 171 | + comandResponse.replace('Limits| volt_limit:', '')) |
| 172 | + self.update() |
| 173 | + |
| 174 | + def connectionStateChanged(self, connectionFlag): |
| 175 | + if connectionFlag is True: |
| 176 | + self.setEnabled(True) |
| 177 | + else: |
| 178 | + self.setEnabled(False) |
0 commit comments