import machine from machine import PWM from machine import ADC from machine import Filament from machine import WDT from machine import Pin from machine import Fram import sys import time import _thread import json import gc import math import os from webserver import send_ws, send_ws_list, py_server # ---------------------------------------------------------------------------- from script.umodbus.serial import ModbusRTU wdt = None mb_server = None selfTestTime = 0 pwmDuty = 0 pwmDutyRayOn = 0 filament = Filament(3) filament.init() filament.set_relay(False) #PWM hvPwm = PWM('pwm1', 2, 46000, 0, 50, False) hvPwmn = PWM('pwm1', 3, 46000, 1023, 50, False) #ADC hvAdc = ADC('adc1', 16) # HV Voltage hiAdc = ADC('adc3', 0) # HV Current tempAdc = ADC('adc2', 15) # HV NTC hvAdc.average(50) hiAdc.average(50) tempAdc.average(50) hvAdcValue = 0 hvKvValue = 0 hvSwitch = False raySwitch = False raySwitchPin = Pin(('GPIOC', 6)) raySwitchPin.init(Pin.IN) rayStartTime = 0 web_socket_list = [] wslock = None filaInfo = { 'relay_stat' : False, 'vout' : 0, 'iout' : 0, 'vin' : 0, 'iin' : 0 } sysErrorList = [] sysInfoList = [] hiAdcValue = 0 hiMaValue = 0 himAOverLimitCount = 0 hvTempValue = 0 filamentCurrent = 0 filamentVoltage = 0 filamentDuty = 0 filamentLoadDuty = 0 averageBuffer = { "hvIdleKv" : [], "hvLoadKv" : [], "fiPreheatCurrent": [], "hvLoadMa": [] } config = { "dev" : { "code" : "1#HVS", "id" : "12345", }, "mqtt" : {}, "hv" : { "kV": 70, "filament": { "preheat": 300, "limit": 1200 }, "mA": 0.7, "xrayAdjustTime": 600, "selfTest" : False }, "var" : { "hv" : { "idlePwm" : 200, "loadPwm" : 320, "limitPwm" : 450 }, "filament" : { "preheatPwm": 50, "limitPwm": 300, "normalPwm": 260 } } } def averageBufferPut(key, value): global averageBuffer if key in averageBuffer: averageBuffer[key].append(value) if len(averageBuffer[key]) > 20: averageBuffer[key].pop(0) def averageBufferGetAverage(key, n): global averageBuffer if key in averageBuffer: values = averageBuffer[key] if len(values) < n: return None average = sum(values[:n]) / n return average return None def mb_control_cb(reg_type, address, val): global hvSwitch, raySwitch, sysInfoList print('control',reg_type,address,val) for value in val: if address == 0: hvSwitch = value == True # mb_server.set_coil(7 - 0, hvSwitch) print("hvSwitch:",hvSwitch) info = { "event" : "hvSwitch", "from" : "modbus", "value" : hvSwitch, "time" : time.ticks_ms() } sysInfoList.append(info) elif address == 1: if value == True: print('alarm clear') # mb_server.set_coil(1, False) elif address == 2: if config['dev']['xray_ctrl_pin_enable']: return raySwitch = value == True # mb_server.set_coil(7 - 2, raySwitch) print("raySwitch:",raySwitch) info = { "event" : "raySwitch", "from" : "modbus", "value" : raySwitch, "time" : time.ticks_ms() } sysInfoList.append(info) address += 1 def mb_param_cb(reg_type, address, val): print('param',reg_type,address,val) for value in val: if address == 0: config['hv'].update({'kV' : value / 100.0}) elif address == 1: config['hv'].update({'mA' : value / 1000.0}) elif address == 2: config['hv']['filament'].update({'limit' : value}) elif address == 3: config['hv']['filament'].update({'preheat' : value}) address += 1 save_config('hv') mb_register_definitions = { "COILS": { "control": { "register": 0, "len": 10, "val": [0,0,0,0,0,0,0,0,0,0], "on_set_cb": mb_control_cb } }, "HREGS": { "params": { "register": 0, "len": 10, "val": [0,0,0,0,0,0,0,0,0,0], "on_set_cb": mb_param_cb } }, "ISTS": { "status": { "register": 0, "len": 10, "val": [0,0,0,0,0,0,0,0,0,0] } }, "IREGS": { "input": { "register": 0, "len": 10, "val": [0,0,0,0,0,0,0,0,0,0] } } } def load_config(): global config config_path = "/config/hv.json" try: with open(config_path, 'r') as f: config['hv'] = json.load(f) except OSError as e: print("文件操作错误:", e) except ValueError as e: print("JSON 解析错误:", e) config_path = "/config/mqtt.json" try: with open(config_path, 'r') as f: config['mqtt'] = json.load(f) except OSError as e: print("文件操作错误:", e) except ValueError as e: print("JSON 解析错误:", e) config_path = "/config/dev.json" try: with open(config_path, 'r') as f: config['dev'] = json.load(f) except OSError as e: print("文件操作错误:", e) except ValueError as e: print("JSON 解析错误:", e) config_path = "/config/var.json" var = None try: varBuf = Fram.read(0, 512) var = json.loads(varBuf) except ValueError as e: print("JSON 解析错误:", e) var = None if var: config['var'] = var with open(config_path, 'w') as f: json.dump(var, f) print('write var.json', var) else: try: with open(config_path, 'r') as f: config['var'] = json.load(f) Fram.write(0, json.dumps(config['var']).encode() + b'\x00') except OSError as e: print("文件操作错误:", e) except ValueError as e: print("JSON 解析错误:", e) def save_config(config_type): if config_type == 'var': Fram.write(0, json.dumps(config['var']).encode() + b'\x00') return try: data = config[config_type] config_path = "/config/" + config_type + '.json' with open(config_path, 'w') as f: f.write(json.dumps(data)) except OSError as e: print("文件操作错误:", e) def mb_init(): global mb_server print("mb_init...") mb_server = ModbusRTU(addr = config['dev']['mb_addr'],baudrate=115200,uart_id=4,ctrl_pin=-2) mb_server.setup_registers(registers=mb_register_definitions) mb_server.set_hreg(0, [ int(config['hv']['kV'] * 100), int(config['hv']['mA'] * 1000), int(config['hv']['filament']['limit']), int(config['hv']['filament']['preheat']), ]) mb_server.set_coil(0, hvSwitch) mb_server.set_coil(2, raySwitch) # if not mb_server.get_bound_status(): # mb_server.bind(local_ip='0.0.0.0', local_port=502) # print("start mb tcp server") def adc2temp(adc_val): Rt = adc_val * 10000.0 / (65535 - adc_val) Rp = 10000.0 T2 = 273.15 + 25.0 Bx = 3950.0 Ka = 273.15 temp = 0.0 temp = Rt / Rp temp = math.log(temp) temp /= Bx temp += (1 / T2) temp = 1 / temp temp -= Ka return temp def hvAdc2kV(hv): return hv / 65535.0 * 3.0 * 3 * 10 def hiAdc2mA(hi): return hi / 65535.0 * 3.0 * 3 / 4.4 #read hv voltage and current, num times, and return the average value def hvAdcRead(num, delay): global filaInfo sumHv = 0 sumHi = 0 for i in range(num): sumHv += hvAdc.read() sumHi += hiAdc.read() time.sleep_ms(delay) sumHv /= num sumHi /= num filaInfo = filament.read() fv = filaInfo['vout'] fi = filaInfo['iout'] return sumHv, sumHi, fv, fi def hvAdcRead(): global filaInfo sumHv = hvAdc.average() sumHi = hiAdc.average() filaInfo = filament.read() fv = filaInfo['vout'] fi = filaInfo['iout'] return sumHv, sumHi, fv, fi def hvAdcPoll(count, delay): global hvAdcValue, hvKvValue, hiAdcValue, hiMaValue global filamentDuty, filamentCurrent, filamentVoltage hv, hi, fv, fi = hvAdcRead() hvAdcValue = hv hiAdcValue = hi hvKvValue = hvAdc2kV(hv) hiMaValue = hiAdc2mA(hi) filamentCurrent = fi filamentVoltage = fv # control the filament current def filamentPreheat(fiPreheat): global filamentCurrent, filamentVoltage, filamentDuty tmpDuty = filamentDuty fi = filamentCurrent if fi > fiPreheat + 100: tmpDuty -= 2 elif fi > fiPreheat + 50: tmpDuty -= 1 elif fi < fiPreheat - 100: tmpDuty += 2 elif fi < fiPreheat - 50: tmpDuty += 1 if tmpDuty < 0: tmpDuty = 0 elif tmpDuty > 750: tmpDuty = 750 filament.set_duty(tmpDuty) filamentDuty = tmpDuty # print('preheat', fiPreheat, tmpDuty) # control the filament current def filamentPreheatFast(fiPreheat): global filamentCurrent, filamentVoltage, filamentDuty if fiPreheat < 0.01: tmpDuty = 0 filament.set_duty(tmpDuty) filamentDuty = tmpDuty return tmpDuty = config['var']['filament']['preheatPwm'] fi = filamentCurrent if tmpDuty > config['var']['filament']['limitPwm']: tmpDuty = config['var']['filament']['limitPwm'] if filamentDuty != tmpDuty: filament.set_duty(tmpDuty) filamentDuty = tmpDuty # print('preheat', fiPreheat, tmpDuty) else: averageBufferPut('fiPreheatCurrent', filamentCurrent) # control the filament current def filamentControlNormal(hiAim, fiLimit): global filamentCurrent, filamentVoltage, filamentDuty tmpDuty = filamentDuty hi = hiMaValue fi = filamentCurrent delta = (hi - hiAim) * 1000 if delta < 0: val = -delta else: val = delta daDelta = 0 if val > 200: daDelta = 2 elif val > 40: daDelta = 1 elif val > 10: daDelta = 0 elif val > 5: daDelta = 0 else: daDelta = 0 if fi > fiLimit: tmpDuty -= 10 elif delta > 0: tmpDuty -= daDelta elif delta < 0: tmpDuty += daDelta if tmpDuty < 0: tmpDuty = 0 elif tmpDuty > config['var']['filament']['limitPwm']: tmpDuty = config['var']['filament']['limitPwm'] filament.set_duty(tmpDuty) # filament.set_duty(0) filamentDuty = tmpDuty # control the filament current def filamentControlFast(hiAim): global filamentCurrent, filamentVoltage, filamentDuty, filamentLoadDuty tmpDuty = filamentDuty if raySwitch: deltaTime = 0 if rayStartTime > 1: now = time.ticks_ms() deltaTime = time.ticks_diff(now, rayStartTime) if deltaTime > config['hv']['xrayAdjustTime']: if deltaTime > config['hv']['xrayAdjustTime'] + 200: if hvKvValue > config['hv']['kV'] - 2 and filamentDuty >= config['var']['filament']['normalPwm']: filamentLoadDuty = filamentDuty averageBufferPut('hvLoadMa', hiMaValue) elif hiMaValue > config['hv']['mA'] + 0.05 and filamentDuty >= config['var']['filament']['normalPwm']: filamentLoadDuty = filamentDuty averageBufferPut('hvLoadMa', hiMaValue) return if hiMaValue > hiAim + 0.1: tmpDuty = tmpDuty - 2 else: aimDuty = config['var']['filament']['normalPwm'] if tmpDuty < aimDuty - 0.2: tmpDuty = tmpDuty + 10 elif tmpDuty < aimDuty: tmpDuty = tmpDuty + 5 if tmpDuty > aimDuty: tmpDuty = aimDuty if hvKvValue < config['hv']['kV'] - 2: return if tmpDuty > config['var']['filament']['limitPwm']: tmpDuty = config['var']['filament']['limitPwm'] filamentDuty = int(tmpDuty) filament.set_duty(filamentDuty) #print('filamentDuty adjust', filamentDuty) # filament.set_duty(0) def hvControlFast(hvAim): global pwmDuty, rayStartTime, pwmDutyRayOn if not hvSwitch: pwmDuty = 0 hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) return if not raySwitch: tmpDuty = config['var']['hv']['idlePwm'] if pwmDuty > tmpDuty: pwmDuty = tmpDuty hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) print("hv adjust to idle", pwmDuty) elif pwmDuty < tmpDuty: pwmDuty = pwmDuty + 3 if pwmDuty > tmpDuty: pwmDuty = tmpDuty hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) print("hv adjust to idle", pwmDuty) else: averageBufferPut('hvIdleKv', hvKvValue) return deltaTime = 0 if rayStartTime > 1: now = time.ticks_ms() deltaTime = time.ticks_diff(now, rayStartTime) if deltaTime > config['hv']['xrayAdjustTime'] + 200: averageBufferPut('hvLoadKv', hvKvValue) pwmDutyRayOn = pwmDuty if deltaTime > config['hv']['xrayAdjustTime']: return if pwmDuty == config['var']['hv']['loadPwm']: return tmpDuty = pwmDuty if hiMaValue > config['hv']['mA'] + 0.1: return if hvKvValue < config['hv']['kV'] - 3: tmpDuty = tmpDuty + 2 elif hvKvValue < config['hv']['kV']: tmpDuty = tmpDuty + 1 if tmpDuty > config['var']['hv']['loadPwm']: tmpDuty = config['var']['hv']['loadPwm'] if pwmDuty > config['var']['hv']['limitPwm']: pwmDuty = config['var']['hv']['limitPwm'] pwmDuty = tmpDuty hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) print("hv adjust", deltaTime, pwmDuty) def hvControl(hvAim): global pwmDuty if not hvSwitch: pwmDuty = 0 hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) return hv = hvKvValue pwmVal = pwmDuty delta = (hv - hvAim) * 1000 if delta < 0: val = -delta else: val = delta pwmDelta = 0 if val > 20000: pwmDelta = 3 elif val > 10000: pwmDelta = 2 elif val > 1000: pwmDelta = 1 else: pwmDelta = 0 if delta > 0: pwmVal -= pwmDelta elif delta < 0: pwmVal += pwmDelta if pwmVal < 0: pwmVal = 0 elif pwmVal > 300: pwmVal = 300 #pwmVal = 30 hvPwm.duty(pwmVal) hvPwmn.duty(1023 - pwmVal) if pwmDuty != pwmVal: pwmDuty = pwmVal print("pwm:%d,%d"%(pwmDelta, pwmDuty)) def mb_reg_update(): mb_server.set_coil(0, hvSwitch) mb_server.set_coil(2, raySwitch) mb_server.set_ireg(0, [ int(hvKvValue * 100), int(hiMaValue * 1000), int(filamentCurrent), int(hvTempValue) ]) def ws_status_update(): status = { 'param' : { 'kV' : config['hv']['kV'], 'mA' : config['hv']['mA'] }, 'value' : { 'hv' : 'on' if hvSwitch else 'off', 'xray' : 'on' if raySwitch else 'off', 'kV' : hvKvValue, 'mA' : hiMaValue, 'fV' : filamentVoltage / 1000, 'fI' : filamentCurrent / 1000, 'Vin' : filaInfo['vin'] / 1000, 'Iin' : filaInfo['iin'] / 1000 } } send_ws_list('/dev/status/hsv', status) def ws_cmd_handler(ws, payload): global hvSwitch, raySwitch, sysInfoList, sysErrorList obj = json.loads(payload) msg = obj['message'] dev_id = msg['device_id'] dev_code = msg['device_code'] cmd = msg['command'] if cmd == 'set_params': value = msg['value'] if 'filament' in value: config['hv']['filament'].update(value['filament']) del value['filament'] config['hv'].update(value) mb_server.set_hreg(0, [ int(config['hv']['kV']), int(config['hv']['mA'] * 1000), int(config['hv']['filament']['limit']), int(config['hv']['filament']['preheat']), ]) print(config['hv']) save_config('hv') elif cmd == 'get_params': msg = config['dev'] msg['command'] = cmd msg['value'] = config['hv'] send_ws(ws, '/dev/response/hsv', msg) elif cmd == 'hv_control': hvSwitch = msg['value'] == 'on' mb_server.set_coil(0, hvSwitch) print("hvSwitch:",hvSwitch) send_ws(ws, '/dev/response/hsv', msg) info = { "event" : "hvSwitch", "from" : "web", "value" : hvSwitch, "time" : time.ticks_ms() } sysInfoList.append(info) elif cmd == 'ray_control': if config['dev']['xray_ctrl_pin_enable']: return raySwitch = msg['value'] == 'on' mb_server.set_coil(2, raySwitch) print("raySwitch:",raySwitch) send_ws(ws, '/dev/response/hsv', msg) info = { "event" : "raySwitch", "from" : "web", "value" : raySwitch, "time" : time.ticks_ms() } sysInfoList.append(info) elif cmd == 'get_var': msg['command'] = cmd msg['value'] = { 'time' : time.ticks_ms(), 'var' : config['var'], 'error' : sysErrorList, 'info' : sysInfoList } send_ws(ws, '/dev/response/hsv', msg) elif cmd == 'set_var': if 'var' in msg['value']: value = msg['value']['var'] else: value = msg['value'] config['var'].update(value) save_config('var') def hvVarCollect(): if not hvSwitch: return if raySwitch: aim = config['hv']['mA'] if hiMaValue < aim * 1.05 and hiMaValue > aim * 0.95: config['var']['hv']['loadPwm'] = pwmDuty else: aim = config['hv']['kV'] if hvKvValue < aim + 1 and hvKvValue > aim - 1: config['var']['hv']['idlePwm'] = pwmDuty def filamentVarCollect(): if not hvSwitch: return if raySwitch: aim = config['hv']['mA'] if hiMaValue < aim * 1.05 and hiMaValue > aim * 0.95: config['var']['filament']['normalPwm'] = filamentDuty else: aim = config['hv']['filament']['preheat'] if filamentCurrent < aim + 50 and filamentCurrent > aim - 50: config['var']['filament']['preheatPwm'] = filamentDuty def varCheckAndSave(): save_config('var') def varUpdate(): hvIdleKv = averageBufferGetAverage('hvIdleKv', 10) hvLoadKv = averageBufferGetAverage('hvLoadKv', 10) fiPreheatCurrent = averageBufferGetAverage('fiPreheatCurrent', 10) hvLoadMa = averageBufferGetAverage('hvLoadMa', 10) print('hvIdleKv', hvIdleKv) print('hvLoadKv', hvLoadKv) print('fiPreheatCurrent', fiPreheatCurrent) print('hvLoadMa', hvLoadMa) if hvIdleKv and hvIdleKv > config['hv']['kV'] + 0.5: config['var']['hv']['idlePwm'] = config['var']['hv']['idlePwm'] - 1 elif hvIdleKv and hvIdleKv < config['hv']['kV'] - 0.5: config['var']['hv']['idlePwm'] = config['var']['hv']['idlePwm'] + 1 if config['var']['hv']['idlePwm'] > config['var']['hv']['limitPwm']: config['var']['hv']['idlePwm'] = config['var']['hv']['limitPwm'] if hvLoadKv and hvLoadKv > config['hv']['kV'] + 0.5: config['var']['hv']['loadPwm'] = config['var']['hv']['loadPwm'] - 1 elif hvLoadKv and hvLoadKv < config['hv']['kV'] - 0.5: config['var']['hv']['loadPwm'] = config['var']['hv']['loadPwm'] + 1 if config['var']['hv']['loadPwm'] > config['var']['hv']['limitPwm']: config['var']['hv']['loadPwm'] = config['var']['hv']['limitPwm'] elif hvLoadKv and pwmDutyRayOn > config['var']['hv']['idlePwm']: config['var']['hv']['loadPwm'] = pwmDutyRayOn if fiPreheatCurrent and fiPreheatCurrent > config['hv']['filament']['preheat'] + 50: config['var']['filament']['preheatPwm'] = config['var']['filament']['preheatPwm'] - 1 elif fiPreheatCurrent and fiPreheatCurrent < config['hv']['filament']['preheat'] - 50: config['var']['filament']['preheatPwm'] = config['var']['filament']['preheatPwm'] + 1 if config['var']['filament']['preheatPwm'] > config['var']['filament']['limitPwm']: config['var']['filament']['preheatPwm'] = config['var']['filament']['limitPwm'] if hvLoadMa and hvLoadMa > config['hv']['mA']: config['var']['filament']['normalPwm'] = filamentLoadDuty - 1 elif hvLoadMa and hvLoadMa < config['hv']['mA'] - 0.03: config['var']['filament']['normalPwm'] = filamentLoadDuty + 1 if config['var']['filament']['normalPwm'] > config['var']['filament']['limitPwm']: config['var']['filament']['normalPwm'] = config['var']['filament']['limitPwm'] save_config('var') print(config['var']) def main(): global config, hvSwitch, raySwitch, wslock, rayStartTime, wdt, selfTestTime, sysErrorList, himAOverLimitCount, hvTempValue exitFlag = False hvStopTime = 0 hvUpdateTime = 0 firstRun = True try: load_config() print(config) if config['dev']['watchdog_enable']: wdt = WDT('wdt', 2) _thread.stack_size(10240) _thread.start_new_thread(py_server,(ws_cmd_handler,)) mb_init() delay = 2 count = 0 print("pwm init success!") print(hvPwm) print("adc init success!") time.sleep_ms(100) while not exitFlag: if hiMaValue < 0.85: if himAOverLimitCount > 0: himAOverLimitCount = himAOverLimitCount - 1 else: error = { "hiMaValue" : hiMaValue, "hvKVValue" : hvKvValue, "hvPwm" : pwmDuty, "filamentPwm" : filamentDuty } if himAOverLimitCount < 5: config['var']['filament']['normalPwm'] = config['var']['filament']['normalPwm'] - 10 himAOverLimitCount = himAOverLimitCount + 1 else: raySwitch = False hvSwitch = False hvControl(0) filament.set_duty(0) time.sleep_ms(100) error['type'] = 'maOverLimit' error['time'] = time.ticks_ms() if len(sysErrorList) > 5: sysErrorList.pop(0) sysErrorList.append(error) if hvKvValue > 70: error = { "hiMaValue" : hiMaValue, "hvKVValue" : hvKvValue, "hvPwm" : pwmDuty, "filamentPwm" : filamentDuty } hvSwitch = False hvControl(0) filament.set_duty(0) error['type'] = 'kvOverLimit' error['time'] = time.time_ms() sysErrorList.append(error) time.sleep_ms(100) if selfTestTime > 0: raySwitch = False tim = time.ticks_diff(time.ticks_ms(), selfTestTime) if tim > 10000: selfTestTime = 0 hvAdcPoll(10, delay) if config['hv']['selfTest'] or selfTestTime > 0: time.sleep_ms(20) else: time.sleep_ms(10) try: mb_server.process() except Exception as e: print('Exception during execution: {}'.format(e)) count = count + 1 if count * delay * 10 > 500: count = 0 if selfTestTime > 0: print("selfTestTime: %d" % tim) #print("pwm: %d %d"%(pwmDuty,filamentDuty)) #print("hv: %d, %.2fkV"%(hvAdcValue, hvKvValue)) #print("hi: %d, %.2fmA"%(hiAdcValue, hiMaValue)) #print("fv: %.2f, fi %d: %.2fA"%(filamentVoltage / 1000, filamentDuty, filamentCurrent / 1000)) #print("xray_ctrl_pin", raySwitchPin.value()) tempVal = tempAdc.average() hvTempValue = adc2temp(tempVal) * 100 # print(tempVal, hvTempValue) # print('\n') #gc.collect() #gc.dump_info() mb_reg_update() ws_status_update() if wdt: wdt.feed() if config['hv']['selfTest'] or selfTestTime > 0: if hvSwitch: hvVarCollect() filamentVarCollect() varCheckAndSave() kV_set = config['hv']['kV'] mA_set = config['hv']['mA'] fi_limit = config['hv']['filament']['limit'] fi_preheat = config['hv']['filament']['preheat'] if hvSwitch: if hvStopTime > 0: tim = time.ticks_diff(time.ticks_ms(), hvStopTime) if tim > 30000: # 30s selfTestTime = time.ticks_ms() hvStopTime = 0 if firstRun: firstRun = False selfTestTime = time.ticks_ms() if filaInfo['relay_stat'] != True: filament.set_relay(True) time.sleep_ms(20) if config['hv']['selfTest'] or selfTestTime > 0: hvControl(kV_set) else: hvControlFast(kV_set) if (not config['hv']['selfTest']) and (selfTestTime == 0): if config['dev']['xray_ctrl_pin_enable']: raySwitch = not raySwitchPin.value() else: raySwitch = False if hvStopTime < 1: hvStopTime = time.ticks_ms() hvControl(0) if filaInfo['relay_stat'] != False: filament.set_relay(False) if not config['hv']['selfTest'] and rayStartTime > 1 and time.ticks_ms() > rayStartTime + 5000: raySwitch = False if raySwitch and hvSwitch: hvUpdateTime = 0 if config['hv']['selfTest'] or selfTestTime > 0: filamentControlNormal(mA_set, fi_limit) else: if rayStartTime < 1: #清空平均缓冲区 averageBuffer['hvLoadKv'] = [] averageBuffer['hvLoadMa'] = [] rayStartTime = time.ticks_ms() filamentControlFast(mA_set) elif hvSwitch: if hvUpdateTime < 1: hvUpdateTime = time.ticks_ms() if config['hv']['selfTest'] or selfTestTime > 0: if count % 10 == 0: filamentPreheat(fi_preheat) else: if rayStartTime > 0: varUpdate() averageBuffer['hvIdleKv'] = [] averageBuffer['fiPreheatCurrent'] = [] hvControlFast(kV_set) elif hvUpdateTime > 0 and time.ticks_diff(time.ticks_ms(), hvUpdateTime) > 3 * 1000: hvUpdateTime = time.ticks_ms() varUpdate() filamentPreheatFast(fi_preheat) rayStartTime = 0 else: hvUpdateTime = 0 rayStartTime = 0 filamentPreheat(fi_preheat) print("main exit") except Exception as e: sys.print_exception(e) finally: exitFlag = True filament.set_duty(0) filament.set_relay(False) hvAdc.deinit() hiAdc.deinit() hvPwm.deinit() hvPwmn.deinit() filament.deinit() print('exit') #time.sleep(1) if __name__ == '__main__': main()