#!/bin/sh

caput FBCK:FB02:TR01:STATE 0
caput -a FBCK:FB02:TR01:POI1 6 12 23 41 23 32 53

# F matrix
caput -a FBCK:FB02:TR01:FMATRIX 17 1 0 0 0 -0.61 2.19 0 0 0 0 1 0 0 0 1.89 2.26 0

# G matrix
caput -a FBCK:FB02:TR01:GMATRIX 10 0.1 0.1 0.1 0.1 0.1 0.1 0.1 1 1 1

# Loop configs
caput FBCK:FB02:TR01:NAME TestLoop
caput FBCK:FB02:TR01:INSTALLED 1
caput FBCK:FB02:TR01:TOTALPOI 1
caput FBCK:FB02:TR01:ITERATEFUNC TrajectoryFit

# Measurements
caput FBCK:FB02:TR01:M1DEVNAME FILE:/tmp/371.X
caput FBCK:FB02:TR01:M1USED 1
caput FBCK:FB02:TR01:M1CAMODE 1
caput FF:BPMS:IN20:371:X 1
caput FF:BPMS:IN20:371:X.EGU mm

caput FBCK:FB02:TR01:M2DEVNAME FILE:/tmp/425.X
caput FBCK:FB02:TR01:M2USED 1
caput FBCK:FB02:TR01:M2CAMODE 1
caput FF:BPMS:IN20:425:X 3
caput FF:BPMS:IN20:425:X.EGU mm

caput FBCK:FB02:TR01:M3DEVNAME FILE:/tmp/371.Y
caput FBCK:FB02:TR01:M3USED 1
caput FBCK:FB02:TR01:M3CAMODE 1
caput FF:BPMS:IN20:371:Y 2
caput FF:BPMS:IN20:371:Y.EGU mm

caput FBCK:FB02:TR01:M4DEVNAME FILE:/tmp/425.Y
caput FBCK:FB02:TR01:M4USED 1
caput FBCK:FB02:TR01:M4CAMODE 1
caput FF:BPMS:IN20:425:Y 4
caput FF:BPMS:IN20:425:Y.EGU mm

# States
caput FBCK:FB02:TR01:S1NAME "X Position"
caput FBCK:FB02:TR01:S1USED 1

caput FBCK:FB02:TR01:S2NAME "X Angle"
caput FBCK:FB02:TR01:S2USED 1

caput FBCK:FB02:TR01:S3NAME "Y Position"
caput FBCK:FB02:TR01:S3USED 1

caput FBCK:FB02:TR01:S4NAME "Y Angle"
caput FBCK:FB02:TR01:S4USED 1

# Actuators
caput FBCK:FB02:TR01:A1DEVNAME FILE:/tmp/221.BCTRL
caput FBCK:FB02:TR01:A1USED 1
caput FBCK:FB02:TR01:A1CAMODE 1
caput FBCK:FB02:TR01:A1.HIHI 1000
caput FBCK:FB02:TR01:A1.LOLO -1000

caput FBCK:FB02:TR01:A2DEVNAME FILE:/tmp/222.BCTRL
caput FBCK:FB02:TR01:A2USED 1
caput FBCK:FB02:TR01:A2CAMODE 1
caput FBCK:FB02:TR01:A2.HIHI 1000
caput FBCK:FB02:TR01:A2.LOLO -1000

caput FBCK:FB02:TR01:A3DEVNAME FILE:/tmp/381.BCTRL
caput FBCK:FB02:TR01:A3USED 0
caput FBCK:FB02:TR01:A3CAMODE 1

caput FBCK:FB02:TR01:A4DEVNAME FILE:/tmp/382.BCTRL
caput FBCK:FB02:TR01:A4USED 0
caput FBCK:FB02:TR01:A4CAMODE 1

# Write same values to the test bpms before enabling the loop
caput FF:BPMS:IN20:371:X 0.1
caput FF:BPMS:IN20:425:X -0.05
caput FF:BPMS:IN20:371:Y 0.04
caput FF:BPMS:IN20:425:Y -0.02

caput FF:BPMS:IN20:371:TMIT 0.1
caput FF:BPMS:IN20:425:TMIT 0.04

#enable loop
caput FBCK:FB02:TR01:INSTALLED 1
caput FBCK:FB02:TR01:STATE ON
