org.yamcs.algo.TimeBinaryDecoder Maven / Gradle / Ivy

Go to download
Show more of this group Show more artifacts with this name
Show all versions of yamcs-core Show documentation
There is a newer version: 5.10.9
package org.yamcs.algo;

import java.util.Map;

import org.yamcs.ConfigurationException;
import org.yamcs.YConfiguration;
import org.yamcs.YamcsServer;
import org.yamcs.algorithms.AlgorithmExecutionContext;
import org.yamcs.mdb.AbstractDataDecoder;
import org.yamcs.mdb.ContainerProcessingContext;
import org.yamcs.parameter.Value;
import org.yamcs.tctm.AbstractPacketPreprocessor.TimeDecoderType;
import org.yamcs.tctm.AbstractPacketPreprocessor.TimeEpochs;
import org.yamcs.tctm.ccsds.time.CucTimeDecoder;
import org.yamcs.time.Instant;
import org.yamcs.time.TimeCorrelationService;
import org.yamcs.utils.BitBuffer;
import org.yamcs.utils.ByteSupplier;
import org.yamcs.utils.ValueUtility;
import org.yamcs.xtce.CustomAlgorithm;
import org.yamcs.xtce.DataEncoding;

/**
 * Can be used in BinaryParameterEncoding to decode binary data directly to absolute times
 * 
 * Unlike the pure XTCE based decoder, this one can use a time correlation service to convert between an on-board time
 * and Yamcs time.
 * 
 */
public class TimeBinaryDecoder extends AbstractDataDecoder {

    final CucTimeDecoder timeDecoder;
    final protected TimeEpochs timeEpoch;
    final TimeCorrelationService tcoService;
    final AlgorithmExecutionContext ctx;

    public TimeBinaryDecoder(CustomAlgorithm alg, AlgorithmExecutionContext ctx, Map conf) {
        YConfiguration yc = YConfiguration.wrap(conf);
        this.ctx = ctx;
        TimeDecoderType type = yc.getEnum("type", TimeDecoderType.class, TimeDecoderType.CUC);

        timeDecoder = switch (type) {
        case CUC -> {
            int implicitPField = yc.getInt("implicitPField", -1);
            int implicitPFieldCont = yc.getInt("implicitPFieldCont", -1);
            yield new CucTimeDecoder(implicitPField, implicitPFieldCont);
        }
        default -> {
            throw new UnsupportedOperationException("unknown time decoder type " + type);
        }
        };
        timeEpoch = yc.getEnum("epoch", TimeEpochs.class, TimeEpochs.GPS);
        if (yc.containsKey("tcoService")) {
            String tcoServiceName = yc.getString("tcoService");
            String yamcsInstance = ctx.getProcessorData().getYamcsInstance();
            tcoService = YamcsServer.getServer().getInstance(yamcsInstance)
                    .getService(TimeCorrelationService.class, tcoServiceName);
            if (tcoService == null) {
                throw new ConfigurationException(
                        "Cannot find a time correlation service with name " + tcoServiceName);
            }
        } else {
            tcoService = null;
        }

    }

    @Override
    public Value extractRaw(DataEncoding de, ContainerProcessingContext pcontext, BitBuffer buf) {
        var suppl = new ByteSupplier() {
            @Override
            public byte getAsByte() {
                return buf.getByte();
            }
        };

        long t;
        if (tcoService != null) {
            long obt = timeDecoder.decodeRaw(suppl);
            long acqTime = pcontext.getAcquisitionTime();
            t = tcoService.getHistoricalTime(Instant.get(acqTime), obt).getMillis();
        } else {
            t = timeDecoder.decode(suppl);
        }

        return ValueUtility.getTimestampValue(t);
    }
}