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 os from webserver import send_ws, send_ws_list, py_server # ---------------------------------------------------------------------------- from script.umodbus.serial import ModbusRTU wdt = None mb_client = None filaFlag = 0 exitFlag = False pwmDuty = 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 hvAdc.average(50) hiAdc.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 } hiAdcValue = 0 hiMaValue = 0 filamentCurrent = 0 filamentVoltage = 0 filamentDuty = 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 n = min(n, len(values)) # 取 n 和当前数组长度的最小值 if n == 0: return 0 # 如果没有值,则返回 0 average = sum(values[:n]) / n return average return None def mb_control_cb(reg_type, address, val): global hvSwitch, raySwitch print('control',reg_type,address,val) for value in val: if address == 0: hvSwitch = value == True mb_client.set_coil(7 - 0, hvSwitch) print("hvSwitch:",hvSwitch) elif address == 1: if value == True: print('alarm clear') mb_client.set_coil(7 - 1, False) elif address == 2: if config['dev']['xray_ctrl_pin_enable']: return raySwitch = value == True mb_client.set_coil(7 - 2, raySwitch) print("raySwitch:",raySwitch) 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_client print("mb_init...") mb_client = ModbusRTU(addr = config['dev']['mb_addr'],baudrate=115200,uart_id=4,ctrl_pin=-2) mb_client.setup_registers(registers=mb_register_definitions) mb_client.set_hreg(0, [ int(config['hv']['kV'] * 100), int(config['hv']['mA'] * 1000), int(config['hv']['filament']['limit']), int(config['hv']['filament']['preheat']), ]) mb_client.set_coil(0, hvSwitch) mb_client.set_coil(2, raySwitch) # if not mb_client.get_bound_status(): # mb_client.bind(local_ip='0.0.0.0', local_port=502) # print("start mb tcp server") 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, filaFlag 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, filaFlag 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, filaFlag 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(): global filamentCurrent, filamentVoltage, filamentDuty, filaFlag aimDuty = config['var']['filament']['normalPwm'] if filamentDuty == aimDuty: averageBufferPut('hvLoadMa', hiMaValue) return tmpDuty = filamentDuty if tmpDuty < aimDuty: tmpDuty = tmpDuty + aimDuty / 5 if tmpDuty > aimDuty: tmpDuty = aimDuty 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 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 if pwmDuty == config['var']['hv']['loadPwm']: averageBufferPut('hvLoadKv', hvKvValue) deltaTime = 0 if rayStartTime > 1: now = time.ticks_ms() deltaTime = time.ticks_diff(now, rayStartTime) if deltaTime > config['hv']['xrayAdjustTime']: return if pwmDuty == config['var']['hv']['loadPwm']: return if hvKvValue > 69: return tmpDuty = pwmDuty if hvKvValue >= config['hv']['kV']: tmpDuty = tmpDuty + 1 elif hvAim > hvKvValue + 3: tmpDuty = tmpDuty + 3 else: tmpDuty = tmpDuty + 2 if tmpDuty > config['var']['hv']['loadPwm']: tmpDuty = config['var']['hv']['loadPwm'] pwmDuty = tmpDuty hvPwm.duty(pwmDuty) hvPwmn.duty(1023 - pwmDuty) print("hv adjust", deltaTime, pwmDuty) def hvControl(hvAim): global pwmDuty, rayStartTime 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 > 450: pwmVal = 450 #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_client.set_ireg(0, [ int(hvKvValue * 100), int(hiMaValue * 1000), int(filamentCurrent), ]) 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 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_client.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_client.set_coil(7 - 0, hvSwitch) print("hvSwitch:",hvSwitch) send_ws(ws, '/dev/response/hsv', msg) elif cmd == 'ray_control': if config['dev']['xray_ctrl_pin_enable']: return raySwitch = msg['value'] == 'on' mb_client.set_coil(7 - 2, raySwitch) print("raySwitch:",raySwitch) send_ws(ws, '/dev/response/hsv', msg) elif cmd == 'get_var': msg['command'] = cmd msg['value'] = config['var'] send_ws(ws, '/dev/response/hsv', msg) elif cmd == 'set_var': 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(): config_path = "/config/var.json" saveFlag = False try: with open(config_path, 'r') as f: conf = json.load(f) if config['var']['hv']['loadPwm'] != conf['hv']['loadPwm'] or \ config['var']['hv']['idlePwm'] != conf['hv']['idlePwm'] or \ config['var']['filament']['normalPwm'] != conf['filament']['normalPwm'] or \ config['var']['filament']['preheatPwm'] != conf['filament']['preheatPwm']: saveFlag = True except OSError as e: print("文件操作错误:", e) except ValueError as e: print("JSON 解析错误:", e) if saveFlag: save_config('var') def varUpdate(): hvIdleKv = averageBufferGetAverage('hvIdleKv', 10) hvLoadKv = averageBufferGetAverage('hvLoadKv', 10) if hvIdleKv and hvIdleKv > config['hv']['kV']: 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 hvLoadKv and hvLoadKv > config['hv']['kV']: 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 fiPreheatCurrent = averageBufferGetAverage('fiPreheatCurrent', 10) 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 hvLoadMa = averageBufferGetAverage('hvLoadMa', 10) if hvLoadMa and hvLoadMa > config['hv']['mA']: config['var']['filament']['normalPwm'] = config['var']['filament']['normalPwm'] - 1 elif hvLoadMa and hvLoadMa < config['hv']['mA'] - 0.03: config['var']['filament']['normalPwm'] = config['var']['filament']['normalPwm'] + 1 save_config('var') print(config['var']) def main(): global config, exitFlag, hvSwitch, raySwitch, wslock, rayStartTime, wdt xrayIdleFlag = False try: load_config() print(config) if config['dev']['watchdog_enable']: wdt = WDT('wdt', 2) _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: hvAdcPoll(10, delay) if config['hv']['selfTest']: time.sleep_ms(20) else: time.sleep_ms(10) try: mb_client.process() except Exception as e: print('Exception during execution: {}'.format(e)) count = count + 1 if count * delay * 10 > 200: count = 0 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()) print('\n') gc.collect() #gc.dump_info() mb_reg_update() ws_status_update() if wdt: wdt.feed() if config['hv']['selfTest']: 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 filaInfo['relay_stat'] != True: filament.set_relay(True) time.sleep_ms(20) if config['hv']['selfTest']: hvControl(kV_set) else: hvControlFast(kV_set) else: hvControl(0) if filaInfo['relay_stat'] != False: filament.set_relay(False) if config['dev']['xray_ctrl_pin_enable']: raySwitch = not raySwitchPin.value() if not hvSwitch: raySwitch = False if raySwitch and hvSwitch: if config['hv']['selfTest']: filamentControlNormal(mA_set, fi_limit) else: if rayStartTime < 1: #清空平均缓冲区 averageBuffer['hvLoadKv'] = [] averageBuffer['hvLoadMa'] = [] rayStartTime = time.ticks_ms() filamentControlFast() elif hvSwitch: if config['hv']['selfTest']: if count % 10 == 0: filamentPreheat(fi_preheat) else: if rayStartTime > 0: averageBuffer['hvIdleKv'] = [] averageBuffer['fiPreheatCurrent'] = [] hvControlFast(kV_set) xrayIdleFlag = True filamentPreheatFast(fi_preheat) rayStartTime = 0 if xrayIdleFlag: xrayIdleFlag = False varUpdate() else: rayStartTime = 0 filamentPreheatFast(0) 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()