Files
2026-11-15 15:24:08 +01:00

66 lines
3.9 KiB
Batchfile

# Script used to control the FAT stage in EL7062 CSP-PC dual-position-loop mode
require ecmccfg 11.0.8 "ENG_MODE=1, EC_RATE=500"
require ecmccomp
epicsEnvSet(ECMC_SLAVE_RESET,false) # Override reset of EL5042
${SCRIPTEXEC} ${ecmccfg_DIR}addSlave.cmd, "SLAVE_ID=2,HW_DESC=EL5042_DC"
#- Shift away the 2 status bits (ST_BITS=26, OFF_BITS=2, total 28bits)
#${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Encoder-Generic-SSI,CH_ID=1,MACROS=MT_BITS=0,ST_BITS=24,CLK_FRQ_KHZ=1000,CODING=0,OFF_BITS=0"
epicsEnvSet(ENC_SID,${ECMC_EC_SLAVE_NUM})
# -------------------------------------------------------------------------------------
# EL5042 Channel 1
# TR-Electronic LT140-S
# SSI / 24 bit / Binary / 1 MHz / 9 V
# -------------------------------------------------------------------------------------
#- To allow change to 9v, 0xF008 must be set to 0x72657375
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0xF008,0x0,0x72657375,4)"
# Disable status bits = TRUE
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x02,1,1)"
# CRC invert = TRUE
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x03,1,1)"
# CRC polynomial = 0
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x11,0,4)"
# Supply voltage = 9.0 V
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x12,90,1)"
# Clock frequency = 1 MHz
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x13,9,1)"
# Coding = Binary / Dual code
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x14,0,1)"
# Multiturn bits = 0
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x15,0,1)"
# Singleturn / position bits = 24
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x16,24,1)"
# Offset LSB bits = 0
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x17,0,1)"
#Mode = SSI
ecmcConfigOrDie "Cfg.EcAddSdo(${ECMC_EC_SLAVE_NUM},0x8008,0x18,1,1)"
epicsEnvSet(ECMC_SLAVE_RESET,true) # Override reset of EL5042
# EL2008 channel 4 supplies 24 V to the EL7062 limit switches
${SCRIPTEXEC} ${ecmccfg_DIR}addSlave.cmd, "SLAVE_ID=5,HW_DESC=EL2008"
epicsEnvSet(BO_SID,${ECMC_EC_SLAVE_NUM})
# EL7062 channel 1 in CSP with centralized ECMC position control (CSP-PC)
${SCRIPTEXEC} ${ecmccfg_DIR}addSlave.cmd, "SLAVE_ID=10,HW_DESC=EL7062_CSP"
${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Motor-Generic-2Phase-Stepper,CH_ID=1,MACROS='I_MAX_MA=800,I_STDBY_MA=500,U_NOM_MV=48000,L_COIL_UH=3080,R_COIL_MOHM=7500,STEPS=400'"
${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Drive-Generic-Ctrl-Params,CH_ID=1,MACROS='L_COIL_UH=3080,R_COIL_MOHM=2471,I_TI=12,I_KP=58,V_TI=150,V_KP=176,P_KP=10'"
#${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Motor-Generic-2Phase-Stepper,CH_ID=2,MACROS='I_MAX_MA=800,I_STDBY_MA=500,U_NOM_MV=48000,L_COIL_UH=3080,R_COIL_MOHM=7500,STEPS=400'"
#${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Drive-Generic-Ctrl-Params,CH_ID=2,MACROS='L_COIL_UH=3080,R_COIL_MOHM=2471,I_TI=12,I_KP=58,V_TI=150,V_KP=176,P_KP=10'"
#- Channel 2 is unused and must be acknowledged for SDO-settings verification
${SCRIPTEXEC} ${ecmccfg_DIR}applyComponent.cmd "COMP=Generic-Ch-Not-Used, CH_ID=2"
epicsEnvSet(DRV_SID,${ECMC_EC_SLAVE_NUM})
${SCRIPTEXEC} ${ecmccfg_DIR}loadYamlAxis.cmd, "FILE=./cfg/axis.yaml,DEV=${IOC},AX_NAME=M1,AXIS_ID=1,DRV_SID=${DRV_SID},ENC_SID=${ENC_SID},ENC_CH=01,BO_SID=${BO_SID}"
${SCRIPTEXEC} ${ecmccfg_DIR}loadYamlEnc.cmd, "FILE=./cfg/enc_open_loop.yaml,DEV=${IOC},ENC_SID=${DRV_SID}"
# PLC configuration
${SCRIPTEXEC} ${ecmccfg_DIR}loadPLCFile.cmd "FILE=./cfg/code_2.plc,SAMPLE_RATE_MS=500,PLC_MACROS='AX_ID=1'"
dbLoadRecords("ecmcPlcAnalog.db","P=$(IOC):,PORT=MC_CPU1,ASYN_NAME=plcs.plc${ECMC_PLC_ID}.static.seqStep,REC_NAME=-M${AX_ID=1}-State")
dbLoadRecords("ecmcPlcBinary.db","P=$(IOC):,PORT=MC_CPU1,ASYN_NAME=plcs.plc${ECMC_PLC_ID}.static.doMotion,REC_NAME=-M${AX_ID=1}-DoMtn")
# Start motion with: caput aik-motion-pc5:Set-M1-DoMtn-RB 1
# Stop motion with: caput aik-motion-pc5:Set-M1-DoMtn-RB 0