12,6 → 12,7 |
import wx.lib |
import wx.lib.plot |
import wx.lib.newevent |
import wx.lib.agw.speedmeter as speedmeter |
|
import mkProto |
|
19,6 → 20,7 |
|
CHANNEL_NAMES = ["GyroYaw", "GyroRoll", "GyroNick", "Pressure", "Batt", "AccTop", "AccRoll", "AccNick"] |
FS = 11111 |
pi = 3.14 |
|
# Needs Numeric or numarray or NumPy |
try: |
53,7 → 55,8 |
wx.Dialog.__init__(self, *args, **kwds) |
self.text_ctrl_1 = wx.TextCtrl(self, -1, "", style=wx.TE_MULTILINE|wx.TE_READONLY|wx.HSCROLL) |
self.button = wx.Button(self, -1, "STOP") |
|
self.voltageCtrl = speedmeter.SpeedMeter(self, extrastyle=speedmeter.SM_DRAW_HAND | speedmeter.SM_DRAW_PARTIAL_SECTORS | speedmeter.SM_DRAW_MIDDLE_ICON ) |
self.speedCtrl = speedmeter.SpeedMeter(self, extrastyle=speedmeter.SM_DRAW_HAND | speedmeter.SM_DRAW_PARTIAL_SECTORS | speedmeter.SM_DRAW_MIDDLE_TEXT | speedmeter.SM_DRAW_SECONDARY_TICKS) |
self.__set_properties() |
self.__do_layout() |
|
60,6 → 63,54 |
self.Bind(wx.EVT_BUTTON, self.onButton, self.button) |
# end wxGlade |
|
YELLOW = wx.Colour(255, 240, 0) |
BG = wx.Colour(0x80, 0x80, 0x80) |
# Configure Voltage Ctrl |
#self.voltageCtrl.SetAngleRange(-3.14/3, 3.14/3) |
self.voltageCtrl.SetAngleRange(0,pi) |
intervals = range(0, 5) |
self.voltageCtrl.SetIntervals(intervals) |
colours = [wx.RED, wx.GREEN, wx.GREEN, YELLOW] |
self.voltageCtrl.SetIntervalColours(colours) |
ticks = ["", "", "", "", ""] |
self.voltageCtrl.SetTicks(ticks) |
self.voltageCtrl.SetTicksColour(wx.WHITE) |
self.voltageCtrl.SetHandColour(YELLOW) |
|
icon = wx.Icon("fuel.ico", wx.BITMAP_TYPE_ICO) |
icon.SetWidth(24) |
icon.SetHeight(24) |
|
self.voltageCtrl.SetMiddleIcon(icon) |
self.voltageCtrl.SetSpeedBackground(BG) |
self.voltageCtrl.SetArcColour(wx.WHITE) |
self.voltageCtrl.SetSpeedValue(2) |
|
|
# Configure Speed Ctr; |
#self.speedCtrl.SetAngleRange(-pi/6, 7*pi/6) |
self.speedCtrl.SetAngleRange(0,pi) |
intervals = range(0, 261, 20) |
self.speedCtrl.SetIntervals(intervals) |
|
colours = [BG]*(len(intervals)-1) |
for i in range(5,10): |
colours[i] = wx.GREEN |
self.speedCtrl.SetIntervalColours(colours) |
ticks = [str(interval) for interval in intervals] |
self.speedCtrl.SetTicks(ticks) |
self.speedCtrl.SetTicksColour(wx.WHITE) |
self.speedCtrl.SetNumberOfSecondaryTicks(1) |
self.speedCtrl.SetTicksFont(wx.Font(7, wx.SWISS, wx.NORMAL, wx.NORMAL)) |
self.speedCtrl.SetMiddleText("Speed") |
self.speedCtrl.SetMiddleTextColour(wx.WHITE) |
self.speedCtrl.SetMiddleTextFont(wx.Font(8, wx.SWISS, wx.NORMAL, wx.BOLD)) |
self.speedCtrl.SetHandColour(YELLOW) |
self.speedCtrl.SetSpeedBackground(BG) |
self.speedCtrl.SetArcColour(wx.WHITE) |
self.speedCtrl.SetSpeedValue(0) |
|
|
self.running = True |
self.Bind(EVT_MEAS_STATUS_UPDATE, self.OnUpdate) |
self.Bind(EVT_MEAS_DATA, self.OnData) |
66,16 → 117,21 |
# The first argument that is passed to the constructor is the parent |
self.app = args[0].app |
self.error = False |
self.firstVoltage = True |
|
|
def __set_properties(self): |
# begin wxGlade: MeasureDialog.__set_properties |
self.SetTitle("Measuring Status") |
self.text_ctrl_1.SetMinSize((400,300)) |
self.voltageCtrl.SetMinSize((50,-1)) |
self.speedCtrl.SetMinSize((50,-1)) |
# end wxGlade |
|
def __do_layout(self): |
# begin wxGlade: MeasureDialog.__do_layout |
sizer_1 = wx.BoxSizer(wx.HORIZONTAL) |
sizer_4 = wx.BoxSizer(wx.VERTICAL) |
sizer_2 = wx.BoxSizer(wx.VERTICAL) |
sizer_1.Add((20, 20), 0, 0, 0) |
sizer_2.Add((20, 20), 0, 0, 0) |
85,6 → 141,10 |
sizer_2.Add((20, 20), 0, 0, 0) |
sizer_1.Add(sizer_2, 1, wx.EXPAND, 0) |
sizer_1.Add((20, 20), 0, 0, 0) |
sizer_4.Add(self.voltageCtrl, 1, wx.EXPAND, 0) |
sizer_4.Add(self.speedCtrl, 1, wx.EXPAND, 0) |
sizer_1.Add(sizer_4, 1, wx.EXPAND, 0) |
sizer_1.Add((20, 20), 0, 0, 0) |
self.SetSizer(sizer_1) |
sizer_1.Fit(self) |
self.Layout() |
93,7 → 153,7 |
def OnData(self, evt): |
print "Received Data" |
self.app.AddTest2(evt.vibTest) |
|
|
def OnUpdate(self, evt): |
print "Status update" |
self.running = evt.running |
106,8 → 166,24 |
if (not self.error): |
self.text_ctrl_1.SetBackgroundColour("Green") |
self.text_ctrl_1.write(" ") # so that the background is redrawn |
self.button.SetLabel("Close") |
self.button.SetLabel("Close") |
|
if evt.speed != None: |
self.speedCtrl.SetSpeedValue(evt.speed) |
|
if evt.voltage != None: |
vmin,vmax,v = evt.voltage |
if self.firstVoltage: |
ticks = ["", "%.1f V"%vmin, "", "%.1f V"%vmax, ""] |
self.voltageCtrl.SetTicks(ticks) |
self.firstVoltage = False |
i = (v-vmin)/(vmax-vmin) # 0..1 |
i *= 2 |
i = i+1 |
i = min(max(i,0),5) |
self.voltageCtrl.SetSpeedValue(i) |
|
|
|
def onButton(self, event): # wxGlade: MeasureDialog.<event_handler> |
if (not self.running): |
574,8 → 650,8 |
if self.cancel: |
raise Exception("Operation cancelled") |
|
def _sendEvent(self, msg, error=False): |
evt = MeasStatusUpdateEvent(running=self.running, msg=msg, error=error) |
def _sendEvent(self, msg=None, error=False, parVoltage=None, speed=None): |
evt = MeasStatusUpdateEvent(running=self.running, msg=msg, error=error, voltage=parVoltage, speed=speed) |
wx.PostEvent(self.evtConsumer, evt) |
|
def _setMotorSpeed(self, speed, settlingTime): |
604,20 → 680,23 |
voltage = msg.getVoltage() |
if (voltage == 0): |
minVoltage = 0 |
maxVoltage = 1 |
else: |
if (voltage > 4.2*3): |
minVoltage = 4*3.5 |
nbCells = 4 |
else: |
minVoltage = 3*3.5 |
|
nbCells = 3 |
minVoltage = nbCells*3.5 |
maxVoltage = nbCells*3.9 |
self._sendEvent("Voltage: %2.1fV" % voltage) |
self._sendEvent("Minimum Voltage: %2.1fV" % minVoltage) |
self._sendEvent("Min/Max Voltage: %2.1fV-%2.1fV" % (minVoltage, maxVoltage), parVoltage=(minVoltage, maxVoltage, voltage)) |
|
|
self._sendEvent("Starting motor(s) (speed=%d)... " % self.param.motorStartupSpeed) |
self._sendEvent("Starting motor(s) (speed=%d)... " % self.param.motorStartupSpeed, speed=self.param.motorStartupSpeed) |
self._setMotorSpeed(self.param.motorStartupSpeed, self.param.motorStartupSettlingTime) |
|
for speed in self.param.speeds: |
self._sendEvent("Changing motor speed to %d... " % speed) |
self._sendEvent("Changing motor speed to %d... " % speed, speed=speed) |
self._setMotorSpeed(speed, 1) |
|
for channel in self.param.channels: |
625,7 → 704,7 |
msg = self.mk.getDebugMsg() |
voltage = msg.getVoltage() |
|
self._sendEvent("Getting data from channel %s" % CHANNEL_NAMES[channel]) |
self._sendEvent("Getting data from channel %s" % CHANNEL_NAMES[channel], parVoltage=(minVoltage, maxVoltage, voltage)) |
data = self.mk.doVibrationTest(1000, channel) |
|
vt = VibTest(self.param.descr, voltage, self.param.motors, speed, CHANNEL_NAMES[channel], data) |