#!/bin/sh

caput FBCK:FB03:TR01:STATE 0

# 1 HZ, pockcel_perm
caput -a FBCK:FB03:TR01:POI1 21 0 0 0 0 0 8 0 0 0 128 0 0 54 0 0 0 0 0 0 0 0


# F matrix
caput -a FBCK:FB03:TR01:FMATRIX 50 1 0 0 0 3 0.97811 1.9127 0 0 3 0.12335 0.80696 0 0 3 1.65 -0.33597 0 0 3 3.1276 -0.39243 0 0 3 0 0 1 0 3 0 0 1.022 1.997 3 0 0 1.8976 4.2539 3 0 0 -0.17824 2.3499 3 0 0 -0.29402 1.5882 3 0 0 0 0 0 0 0 0 0

# G matrix
caput -a FBCK:FB03:TR01:GMATRIX 10 2.5181 2.8809 0 0 -0.33363 1.1087 0 0 0 0 -0.34556 2.3591 0 0 -0.5343 0.89322 0 0 0 0 

# Loop configs
caput FBCK:FB03:TR01:NAME InjLaunchFILE
caput FBCK:FB03:TR01:INSTALLED 1
caput FBCK:FB03:TR01:TOTALPOI 1
caput FBCK:FB03:TR01:ITERATEFUNC TrajectoryFit

# Measurements
caput FBCK:FB03:TR01:M1DEVNAME FILE:/data/dat/BPMS:IN20:581:X
caput FBCK:FB03:TR01:M1USED 1
caput FBCK:FB03:TR01:M1CAMODE 1

caput FBCK:FB03:TR01:M2DEVNAME FILE:/data/dat/BPMS:IN20:631:X
caput FBCK:FB03:TR01:M2USED 1
caput FBCK:FB03:TR01:M2CAMODE 1

caput FBCK:FB03:TR01:M3DEVNAME FILE:/data/dat/BPMS:IN20:651:X
caput FBCK:FB03:TR01:M3USED 1
caput FBCK:FB03:TR01:M3CAMODE 1

caput FBCK:FB03:TR01:M4DEVNAME FILE:/data/dat/BPMS:IN20:771:X
caput FBCK:FB03:TR01:M4USED 1
caput FBCK:FB03:TR01:M4CAMODE 1

caput FBCK:FB03:TR01:M5DEVNAME FILE:/data/dat/BPMS:IN20:781:X
caput FBCK:FB03:TR01:M5USED 1
caput FBCK:FB03:TR01:M5CAMODE 1

caput FBCK:FB03:TR01:M6DEVNAME FILE:/data/dat/BPMS:IN20:581:Y
caput FBCK:FB03:TR01:M6USED 1
caput FBCK:FB03:TR01:M6CAMODE 1

caput FBCK:FB03:TR01:M7DEVNAME FILE:/data/dat/BPMS:IN20:631:Y
caput FBCK:FB03:TR01:M7USED 1
caput FBCK:FB03:TR01:M7CAMODE 1

caput FBCK:FB03:TR01:M8DEVNAME FILE:/data/dat/BPMS:IN20:651:Y
caput FBCK:FB03:TR01:M8USED 1
caput FBCK:FB03:TR01:M8CAMODE 1

caput FBCK:FB03:TR01:M9DEVNAME FILE:/data/dat/BPMS:IN20:771:Y
caput FBCK:FB03:TR01:M9USED 1
caput FBCK:FB03:TR01:M9CAMODE 1

caput FBCK:FB03:TR01:M10DEVNAME FILE:/data/dat/BPMS:IN20:781:Y
caput FBCK:FB03:TR01:M10USED 1
caput FBCK:FB03:TR01:M10CAMODE 1

caput FBCK:FB03:TR01:M11USED 0
caput FBCK:FB03:TR01:M12USED 0
caput FBCK:FB03:TR01:M13USED 0
caput FBCK:FB03:TR01:M14USED 0
caput FBCK:FB03:TR01:M15USED 0
caput FBCK:FB03:TR01:M16USED 0
caput FBCK:FB03:TR01:M17USED 0
caput FBCK:FB03:TR01:M18USED 0
caput FBCK:FB03:TR01:M19USED 0

# Reference orbit
# Aug 31 9:15
caput -a FBCK:FB03:TR01:REFORBIT 10 -0.0059313 -0.12648 -0.13236 0.051098 -0.082934 -0.10219 -0.0022403 -0.03867 0.10587 -0.16693
# Previous ref orbit
#caput -a FBCK:FB03:TR01:REFORBIT 11 -0.19099 0.079905 -0.029444 -0.1043 0.034737 -0.16635 0 0 0 0.1016 -0.1544 -0.03919 -0.069549 0.15241 -0.12974 0 0 0 0

# States
caput FBCK:FB03:TR01:S1NAME FILE:/data/dat/X.Position
caput FBCK:FB03:TR01:S1USED 1

caput FBCK:FB03:TR01:S2NAME FILE:/data/dat/X.Angle
caput FBCK:FB03:TR01:S2USED 1

caput FBCK:FB03:TR01:S3NAME FILE:/data/dat/Y.Position
caput FBCK:FB03:TR01:S3USED 1

caput FBCK:FB03:TR01:S4NAME FILE:/data/dat/Y.Angle
caput FBCK:FB03:TR01:S4USED 1

# Actuators
caput FBCK:FB03:TR01:A1DEVNAME FILE:/data/dat/XCOR:IN20:381:BCTRL
caput FBCK:FB03:TR01:A1USED 1
caput FBCK:FB03:TR01:A1CAMODE 1

caput FBCK:FB03:TR01:A2DEVNAME FILE:/data/dat/XCOR:IN20:521:BCTRL
caput FBCK:FB03:TR01:A2USED 1
caput FBCK:FB03:TR01:A2CAMODE 1

caput FBCK:FB03:TR01:A3DEVNAME FILE:/data/dat/YCOR:IN20:382:BCTRL
caput FBCK:FB03:TR01:A3USED 1
caput FBCK:FB03:TR01:A3CAMODE 1

caput FBCK:FB03:TR01:A4DEVNAME FILE:/data/dat/YCOR:IN20:522:BCTRL
caput FBCK:FB03:TR01:A4USED 1
caput FBCK:FB03:TR01:A4CAMODE 1

# Energy
caput -a FBCK:FB03:TR01:ACTENERGY 4 0.073564 0.135 0.073564 0.135

# Must set these up in order to have the config app work
caput FBCK:FB03:TR01:MEASNUM 10
caput FBCK:FB03:TR01:ACTNUM 4
caput FBCK:FB03:TR01:STATENUM 4
caput FBCK:FB03:TR01:PGAIN 0.1

# Enable loop
caput FBCK:FB03:TR01:INSTALLED 1
#caput FBCK:FB03:TR01:STATE 1
