512 lines
23 KiB
Go
512 lines
23 KiB
Go
package memory
|
||
|
||
import (
|
||
"encoding/binary"
|
||
"encoding/hex"
|
||
"fmt"
|
||
"joylink.club/bj-rtsts-server/config"
|
||
"joylink.club/bj-rtsts-server/const/balise_const"
|
||
"joylink.club/bj-rtsts-server/dto/data_proto"
|
||
"joylink.club/bj-rtsts-server/dto/request_proto"
|
||
"joylink.club/bj-rtsts-server/dto/state_proto"
|
||
"joylink.club/bj-rtsts-server/sys_error"
|
||
"joylink.club/bj-rtsts-server/third_party/can_btm"
|
||
"joylink.club/bj-rtsts-server/third_party/dynamics"
|
||
"joylink.club/bj-rtsts-server/third_party/message"
|
||
train_pc_sim "joylink.club/bj-rtsts-server/third_party/train_pc_sim"
|
||
"log/slog"
|
||
"strings"
|
||
"time"
|
||
)
|
||
|
||
func (s *VerifySimulation) GetTrainPcSimConfig() config.VehiclePCSimConfig {
|
||
return s.runConfig.PcSimConfig
|
||
}
|
||
|
||
// 列车控制
|
||
func ControlTrainUpdate(s *VerifySimulation, ct *request_proto.TrainControl) {
|
||
allTrainMap := &s.Memory.Status.TrainStateMap
|
||
data, ok := allTrainMap.Load(ct.TrainId)
|
||
if !ok {
|
||
panic(sys_error.New(fmt.Sprintf("列车【%s】不存在", ct.TrainId)))
|
||
}
|
||
tccGraphicData := findTrainTccGraphicData(s)
|
||
if tccGraphicData == nil {
|
||
slog.Error("列车控制未找到TCC图形数据")
|
||
panic(sys_error.New("未找到TCC图形数据"))
|
||
}
|
||
sta := data.(*state_proto.TrainState)
|
||
var tce []train_pc_sim.TrainControlEvent = nil
|
||
if ct.ControlType == request_proto.TrainControl_EMERGENT_BUTTON {
|
||
trainControlEB(sta, ct.Button, ct.DeviceId, tccGraphicData)
|
||
} else if ct.ControlType == request_proto.TrainControl_DRIVER_KEY_SWITCH {
|
||
tce = trainControlDriverKey(sta, ct.DriverKey, ct.DeviceId, tccGraphicData)
|
||
train_pc_sim.Default().SendDriverActive(sta.ConnState, sta.VobcState)
|
||
|
||
} else if ct.ControlType == request_proto.TrainControl_DIRECTION_KEY_SWITCH {
|
||
trainControlDirKey(sta, ct.DirKey, ct.DeviceId, tccGraphicData)
|
||
} else if ct.ControlType == request_proto.TrainControl_HANDLER {
|
||
oldTraction := sta.VobcState.TractionForce
|
||
oldBrakeForce := sta.VobcState.BrakeForce
|
||
tce = trainControlHandle(sta, ct.Handler, ct.DeviceId, tccGraphicData)
|
||
train_pc_sim.Default().SendHandleSwitch(oldTraction, oldBrakeForce, sta.ConnState, sta.VobcState)
|
||
}
|
||
|
||
if sta.ConnState.Conn && sta.ConnState.ConnType == state_proto.TrainConnState_PC_SIM && tce != nil {
|
||
train_pc_sim.Default().PublishTrainControlEvent(s.World, tce)
|
||
}
|
||
cm := &message.TrainControlMsg{TrainId: ct.TrainId, ControlInfo: sta.VobcState}
|
||
dynamics.Default().SendTrainControl(cm)
|
||
}
|
||
|
||
func trainControlEB(trainState *state_proto.TrainState, request *request_proto.TrainControl_EmergentButton, deviceId uint32, tccGraphic *data_proto.TccGraphicStorage) {
|
||
|
||
_, find := findTrainTccGraphicDataButton(tccGraphic, deviceId)
|
||
if !find {
|
||
slog.Error("未找到对应的紧急停车摁钮,deviceId:", deviceId)
|
||
return
|
||
}
|
||
trainState.VobcState.EmergencyBrakingStatus = request.Active
|
||
if trainState.Tcc.Ebutton == nil {
|
||
trainState.Tcc.Ebutton = &state_proto.TrainControlState_EmergentButton{Id: deviceId, Passed: request.Active}
|
||
} else {
|
||
trainState.Tcc.Ebutton.Passed = request.Active
|
||
}
|
||
}
|
||
|
||
// 列车方向
|
||
func trainControlDirKey(trainState *state_proto.TrainState, request *request_proto.TrainControl_DirectionKeySwitch, deviceId uint32, tccGraphic *data_proto.TccGraphicStorage) {
|
||
_, find := findTrainTccGraphicDataKey(tccGraphic, deviceId)
|
||
if !find {
|
||
slog.Error("未找到对应的列车方向键deviceId:", deviceId)
|
||
return
|
||
}
|
||
trainState.VobcState.DirectionForward = false
|
||
trainState.VobcState.DirectionBackward = false
|
||
trainState.RunDirection = false
|
||
if request.Val == 1 {
|
||
trainState.VobcState.DirectionForward = true
|
||
trainState.RunDirection = true
|
||
|
||
} else if request.Val == 0 {
|
||
trainState.VobcState.DirectionBackward = true
|
||
trainState.RunDirection = false
|
||
|
||
}
|
||
if trainState.Tcc.DirKey == nil {
|
||
trainState.Tcc.DirKey = &state_proto.TrainControlState_DirectionKeySwitch{Id: deviceId, Val: request.Val}
|
||
} else {
|
||
trainState.Tcc.DirKey.Val = request.Val
|
||
}
|
||
|
||
}
|
||
|
||
// 列车驾驶端激活
|
||
func trainControlDriverKey(trainState *state_proto.TrainState, request *request_proto.TrainControl_DriverKeySwitch, deviceId uint32, tccGraphic *data_proto.TccGraphicStorage) []train_pc_sim.TrainControlEvent {
|
||
obj, find := findTrainTccGraphicDataKey(tccGraphic, deviceId)
|
||
if !find {
|
||
slog.Error("未找到对应的驾驶端激活设备deviceId:", deviceId)
|
||
return nil
|
||
}
|
||
|
||
if obj.Code == "SKQYS1" {
|
||
trainState.VobcState.Tc1Active = request.Val
|
||
} else if obj.Code == "SKQYS2" {
|
||
trainState.VobcState.Tc2Active = request.Val
|
||
}
|
||
var addNew = true
|
||
for _, k := range trainState.Tcc.DriverKey {
|
||
if k.Id == deviceId {
|
||
k.Id = deviceId
|
||
k.Val = request.Val
|
||
addNew = false
|
||
break
|
||
}
|
||
}
|
||
if addNew {
|
||
trainState.Tcc.DriverKey = append(trainState.Tcc.DriverKey, &state_proto.TrainControlState_DriverKeySwitch{Id: deviceId, Val: request.Val})
|
||
}
|
||
return []train_pc_sim.TrainControlEvent{{Command: message.KEY_STATE, Status: message.IsTrue(request.Val)}}
|
||
|
||
}
|
||
|
||
// 列车牵引控制
|
||
func trainControlHandle(trainState *state_proto.TrainState, request *request_proto.TrainControl_PushHandler, deviceId uint32, tccGraphic *data_proto.TccGraphicStorage) []train_pc_sim.TrainControlEvent {
|
||
_, find := findTrainTccGraphicDataHandler(tccGraphic, deviceId)
|
||
if !find {
|
||
slog.Error("未找到对应的牵引制动手柄设备deviceId:", deviceId)
|
||
return nil
|
||
}
|
||
|
||
trainState.VobcState.TractionStatus = false
|
||
trainState.VobcState.TractionForce = 0
|
||
trainState.VobcState.BrakingStatus = false
|
||
trainState.VobcState.BrakeForce = 0
|
||
tce := make([]train_pc_sim.TrainControlEvent, 0)
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_FORWORD, Status: 0})
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_BACKWORD, Status: 0})
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_TO_ZERO, Status: 0})
|
||
if request.Val > 0 {
|
||
trainState.VobcState.TractionStatus = true
|
||
trainState.VobcState.TractionForce = int64(request.Val * 18000)
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_FORWORD, Status: 1})
|
||
} else if request.Val < 0 {
|
||
trainState.VobcState.BrakingStatus = true
|
||
trainState.VobcState.BrakeForce = int64(request.Val * 18000)
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_BACKWORD, Status: 1})
|
||
} else {
|
||
|
||
tce = append(tce, train_pc_sim.TrainControlEvent{Command: message.HANDLE_TO_ZERO, Status: 1})
|
||
}
|
||
if trainState.Tcc.PushHandler == nil {
|
||
trainState.Tcc.PushHandler = &state_proto.TrainControlState_PushHandler{Id: deviceId, Val: request.Val}
|
||
} else {
|
||
trainState.Tcc.PushHandler.Val = request.Val
|
||
}
|
||
return tce
|
||
}
|
||
|
||
func (s *VerifySimulation) GetConnTrain() *state_proto.TrainState {
|
||
return s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
}
|
||
func (s *VerifySimulation) findConnTrain(ct state_proto.TrainConnState_TrainConnType) *state_proto.TrainState {
|
||
var findTrain *state_proto.TrainState
|
||
s.Memory.Status.TrainStateMap.Range(func(k, v any) bool {
|
||
train := v.(*state_proto.TrainState)
|
||
connState := train.ConnState
|
||
if connState.ConnType == ct {
|
||
findTrain = train
|
||
return false
|
||
}
|
||
return true
|
||
})
|
||
return findTrain
|
||
}
|
||
|
||
// 4.4.1. 车载输出数字量信息报文内容
|
||
func (s *VerifySimulation) TrainPcSimDigitalOutInfoHandle(data []byte) {
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("车载输出数字量，未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
if !train.ConnState.Conn {
|
||
slog.Error("车载输出数字量，,列车未连接车载pc仿真")
|
||
return
|
||
}
|
||
//buf := bytes.NewBuffer(data)
|
||
vobc := train.VobcState
|
||
|
||
//cutTraction, _ := buf.ReadByte() //切牵引
|
||
//trainDoorOutLed, _ := buf.ReadByte() //车门外指示灯
|
||
//stopBrakeAppend, _ := buf.ReadByte() //停放制动施加
|
||
//emergentBrake, _ := buf.ReadByte() //紧急制动
|
||
//leftOpenDoor, _ := buf.ReadByte() //开左门允许
|
||
//rightOpenDoor, _ := buf.ReadByte() //开右门允许
|
||
//closeRightDoor, _ := buf.ReadByte() //关右门
|
||
//doorAlwaysClosed, _ := buf.ReadByte() //车门保持关闭
|
||
//localAtpControl, _ := buf.ReadByte() //本端ATP控车
|
||
//atoMode, _ := buf.ReadByte() //ATO模式
|
||
//atoTractionCommandOut, _ := buf.ReadByte() //ATO牵引命令输出
|
||
//atoTractionCommand1, _ := buf.ReadByte() //ATO牵引指令1
|
||
//atoTractionCommand2, _ := buf.ReadByte() //ATO牵引指令2
|
||
//atoTractionCommand3, _ := buf.ReadByte() //ATO牵引指令3
|
||
//atoBrakeCommand, _ := buf.ReadByte() //ATO制动命令输出
|
||
//skipCommand, _ := buf.ReadByte() //跳跃指令
|
||
//direction1, _ := buf.ReadByte() //列车方向1
|
||
//direction2, _ := buf.ReadByte() //列车方向2
|
||
//atoLazyCommandOut, _ := buf.ReadByte() //ATO惰行命令输出
|
||
//sleepCommand, _ := buf.ReadByte() //休眠指令
|
||
//wakeUpCommand, _ := buf.ReadByte() //唤醒指令
|
||
//toPullTrainLed, _ := buf.ReadByte() //ATO发车指示灯
|
||
//arLightCommand, _ := buf.ReadByte() //AR灯命令
|
||
//atoAlwaysBrake, _ := buf.ReadByte() //ATO保持制动
|
||
//atoOpenLeftDoor, _ := buf.ReadByte() //ATO开左门
|
||
//atoOpenRightDoor, _ := buf.ReadByte() //ATO开右门
|
||
//atoCloseLeftDoor, _ := buf.ReadByte() //ATO关左门
|
||
//ariverActive, _ := buf.ReadByte() //驾驶室激活
|
||
//noSpeedSigle, _ := buf.ReadByte() //零速信号
|
||
//famMode, _ := buf.ReadByte() //FAM模式
|
||
//camMode, _ := buf.ReadByte() //CAM模式
|
||
//trainStartedLed, _ := buf.ReadByte() //列车启动指示灯
|
||
//mostUseBrake, _ := buf.ReadByte() //常用制动
|
||
//splittingOut, _ := buf.ReadByte() //过分相输出
|
||
//modeRelay, _ := buf.ReadByte() //模式继电器
|
||
//tractionEffective, _ := buf.ReadByte() //牵引有效
|
||
//brakeEffective, _ := buf.ReadByte() //制动有效
|
||
//lifeDoorUsed, _ := buf.ReadByte() //逃生门使能
|
||
//brakeQuarantine, _ := buf.ReadByte() //制动隔离
|
||
//stopNotAllBrake, _ := buf.ReadByte() //停放制动缓解
|
||
|
||
//vobc.TractionSafetyCircuit = message.IsTrueForByte(cutTraction)
|
||
//vobc.TrainDoorOutLed = message.IsTrueForByte(trainDoorOutLed) //? 说明暂无此属性
|
||
//vobc.ParkingBrakeStatus = message.IsTrueForByte(stopBrakeAppend)
|
||
//vobc.EmergencyBrakingStatus = message.IsTrueForByte(emergentBrake)
|
||
//vobc.LeftDoorOpenCommand = message.IsTrueForByte(leftOpenDoor)
|
||
//vobc.RightDoorOpenCommand = message.IsTrueForByte(rightOpenDoor)
|
||
//vobc.RightDoorCloseCommand = message.IsTrueForByte(closeRightDoor)
|
||
//vobc.AllDoorClose = message.IsTrueForByte(doorAlwaysClosed)
|
||
|
||
//vobc.LocalAtpControl = message.IsTrueForByte(localAtpControl) //?
|
||
//vobc.Ato = message.IsTrueForByte(atoMode)
|
||
//vobc.AtoTractionCommandOut = message.IsTrueForByte(atoTractionCommandOut) //?
|
||
//vobc.AtoTractionCommand1 = message.IsTrueForByte(atoTractionCommand1) //?
|
||
//vobc.AtoTractionCommand2 = message.IsTrueForByte(atoTractionCommand2) //?
|
||
//vobc.AtoTractionCommand3 = message.IsTrueForByte(atoTractionCommand3) //?
|
||
//vobc.AtoBrakeCommand = message.IsTrueForByte(atoBrakeCommand) //?
|
||
//vobc.JumpStatus = message.IsTrueForByte(skipCommand)
|
||
|
||
//vobc.DirectionForward = message.IsTrueForByte(direction1)
|
||
//vobc.DirectionBackward = message.IsTrueForByte(direction2)
|
||
//vobc.AtoLazyCommandOut = message.IsTrueForByte(atoLazyCommandOut) //?
|
||
//vobc.SleepBtn = message.IsTrueForByte(sleepCommand)
|
||
//vobc.WakeUpBtn = message.IsTrueForByte(wakeUpCommand)
|
||
//vobc.AtoSendTrainBtn = message.IsTrueForByte(toPullTrainLed)
|
||
//vobc.TurnbackStatus = message.IsTrueForByte(arLightCommand) //?
|
||
//vobc.AtoAlwaysBrake = message.IsTrueForByte(atoAlwaysBrake) //?
|
||
|
||
//vobc.AtoOpenLeftDoor = message.IsTrueForByte(atoOpenLeftDoor) //?
|
||
//vobc.AtoOpenRightDoor = message.IsTrueForByte(atoOpenRightDoor) //?
|
||
//vobc.AtoCloseLeftDoor = message.IsTrueForByte(atoCloseLeftDoor) //?
|
||
//vobc.Tc1Active = message.IsTrueForByte(ariverActive)
|
||
//vobc.NoSpeedSigle = message.IsTrueForByte(noSpeedSigle) //?
|
||
//vobc.Fam = message.IsTrueForByte(famMode)
|
||
//vobc.Cam = message.IsTrueForByte(camMode)
|
||
//vobc.TrainStartedLed = message.IsTrueForByte(trainStartedLed) //?
|
||
|
||
//vobc.MostUseBrake = message.IsTrueForByte(mostUseBrake) //? //常用制动
|
||
//vobc.SplittingOut = message.IsTrueForByte(splittingOut) //? //过分相输出
|
||
//vobc.ModeRelay = message.IsTrueForByte(modeRelay) //? //模式继电器
|
||
//vobc.TractionEffective = message.IsTrueForByte(tractionEffective) //? //牵引有效
|
||
//vobc.BrakeEffective = message.IsTrueForByte(brakeEffective) //? //制动有效
|
||
//vobc.LifeDoorState = message.IsTrueForByte(lifeDoorUsed) //逃生门使能
|
||
//vobc.BrakeQuarantine = message.IsTrueForByte(brakeQuarantine) //? //制动隔离
|
||
//vobc.StopNotAllBrake = message.IsTrueForByte(stopNotAllBrake) //? //停放制动缓解
|
||
trainPcSimDigitalOutInfoHandleCode39_32(data[0], vobc)
|
||
trainPcSimDigitalOutInfoHandleCode31_24(data[1], vobc)
|
||
trainPcSimDigitalOutInfoHandleCode23_16(data[2], vobc)
|
||
trainPcSimDigitalOutInfoHandleCode15_8(data[3], vobc)
|
||
trainPcSimDigitalOutInfoHandleCode7_0(data[4], vobc)
|
||
cm := &message.TrainControlMsg{TrainId: train.Id, ControlInfo: vobc}
|
||
dynamics.Default().SendTrainControl(cm)
|
||
}
|
||
func trainPcSimDigitalOutInfoHandleCode39_32(d byte, vobc *state_proto.TrainVobcState) {
|
||
vobc.MostUseBrake = message.IsTrueForByte(message.GetBit(d, 0)) //? //常用制动
|
||
vobc.SplittingOut = message.IsTrueForByte(message.GetBit(d, 1)) //? //过分相输出
|
||
vobc.ModeRelay = message.IsTrueForByte(message.GetBit(d, 2)) //? //模式继电器
|
||
vobc.TractionEffective = message.IsTrueForByte(message.GetBit(d, 3)) //? //牵引有效
|
||
vobc.BrakeEffective = message.IsTrueForByte(message.GetBit(d, 4)) //? //制动有效
|
||
vobc.LifeDoorState = message.IsTrueForByte(message.GetBit(d, 5)) //逃生门使能
|
||
vobc.BrakeQuarantine = message.IsTrueForByte(message.GetBit(d, 6)) //? //制动隔离
|
||
vobc.StopNotAllBrake = message.IsTrueForByte(message.GetBit(d, 7)) //? //停放制动缓解
|
||
|
||
}
|
||
func trainPcSimDigitalOutInfoHandleCode31_24(d byte, vobc *state_proto.TrainVobcState) {
|
||
vobc.AtoOpenLeftDoor = message.IsTrueForByte(message.GetBit(d, 0)) //?//ATO开左门
|
||
vobc.AtoOpenRightDoor = message.IsTrueForByte(message.GetBit(d, 1)) //?//ATO开右门
|
||
vobc.AtoCloseLeftDoor = message.IsTrueForByte(message.GetBit(d, 2)) //?//ATO关左门
|
||
vobc.Tc1Active = message.IsTrueForByte(message.GetBit(d, 3)) //驾驶室激活
|
||
vobc.NoSpeedSigle = message.IsTrueForByte(message.GetBit(d, 4)) //?//零速信号
|
||
vobc.Fam = message.IsTrueForByte(message.GetBit(d, 5)) //FAM模式
|
||
vobc.Cam = message.IsTrueForByte(message.GetBit(d, 6)) //CAM模式
|
||
vobc.TrainStartedLed = message.IsTrueForByte(message.GetBit(d, 7)) //?//列车启动指示灯
|
||
|
||
}
|
||
func trainPcSimDigitalOutInfoHandleCode23_16(d byte, vobc *state_proto.TrainVobcState) {
|
||
vobc.DirectionForward = message.IsTrueForByte(message.GetBit(d, 0)) //列车方向1
|
||
vobc.DirectionBackward = message.IsTrueForByte(message.GetBit(d, 1)) //列车方向2
|
||
vobc.AtoLazyCommandOut = message.IsTrueForByte(message.GetBit(d, 2)) //?//ATO惰行命令输出
|
||
vobc.SleepBtn = message.IsTrueForByte(message.GetBit(d, 3)) //休眠指令
|
||
vobc.WakeUpBtn = message.IsTrueForByte(message.GetBit(d, 4)) //唤醒指令
|
||
vobc.AtoSendTrainBtn = message.IsTrueForByte(message.GetBit(d, 5)) //ATO发车指示灯
|
||
vobc.TurnbackStatus = message.IsTrueForByte(message.GetBit(d, 6)) //?//AR灯命令
|
||
vobc.AtoAlwaysBrake = message.IsTrueForByte(message.GetBit(d, 7)) //? //ATO保持制动
|
||
|
||
}
|
||
func trainPcSimDigitalOutInfoHandleCode15_8(d byte, vobc *state_proto.TrainVobcState) {
|
||
vobc.LocalAtpControl = message.IsTrueForByte(message.GetBit(d, 0)) //?//本端ATP控车
|
||
vobc.Ato = message.IsTrueForByte(message.GetBit(d, 1)) //ATO模式
|
||
vobc.AtoTractionCommandOut = message.IsTrueForByte(message.GetBit(d, 2)) //?//ATO牵引命令输出
|
||
vobc.AtoTractionCommand1 = message.IsTrueForByte(message.GetBit(d, 3)) //?//ATO牵引指令1
|
||
vobc.AtoTractionCommand2 = message.IsTrueForByte(message.GetBit(d, 4)) //?//ATO牵引指令2
|
||
vobc.AtoTractionCommand3 = message.IsTrueForByte(message.GetBit(d, 5)) //?//ATO牵引指令3
|
||
vobc.AtoBrakeCommand = message.IsTrueForByte(message.GetBit(d, 6)) //?//ATO制动命令输出
|
||
vobc.JumpStatus = message.IsTrueForByte(message.GetBit(d, 7)) //跳跃指令
|
||
|
||
}
|
||
func trainPcSimDigitalOutInfoHandleCode7_0(d byte, vobc *state_proto.TrainVobcState) {
|
||
vobc.TractionSafetyCircuit = message.IsTrueForByte(message.GetBit(d, 0)) //切牵引
|
||
vobc.TrainDoorOutLed = message.IsTrueForByte(message.GetBit(d, 1)) //? 说明暂无此属性
|
||
vobc.ParkingBrakeStatus = message.IsTrueForByte(message.GetBit(d, 2)) //停放制动施加
|
||
vobc.EmergencyBrakingStatus = message.IsTrueForByte(message.GetBit(d, 3)) //紧急制动
|
||
vobc.LeftDoorOpenCommand = message.IsTrueForByte(message.GetBit(d, 4)) //开左门允许
|
||
vobc.RightDoorOpenCommand = message.IsTrueForByte(message.GetBit(d, 5)) //开右门允许
|
||
vobc.RightDoorCloseCommand = message.IsTrueForByte(message.GetBit(d, 6)) //关右门
|
||
vobc.AllDoorClose = message.IsTrueForByte(message.GetBit(d, 7)) //车门保持关闭
|
||
|
||
}
|
||
|
||
// 4.4.2. 车载输出数字反馈量信息报文内容
|
||
func (s *VerifySimulation) TrainPcSimDigitalReportHandle(data []byte) {
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("车载输出数字反馈量信息,未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
if !train.ConnState.Conn {
|
||
slog.Error("车载输出数字反馈量信息,列车未连接车载pc仿真")
|
||
return
|
||
}
|
||
vobc := train.VobcState
|
||
|
||
//buf := bytes.NewBuffer(data)
|
||
//localEndAct, _ := buf.ReadByte()
|
||
//direction1, _ := buf.ReadByte()
|
||
//direction2, _ := buf.ReadByte()
|
||
//vobc.Tc1Active = message.IsTrueForByte(localEndAct) //本端驾驶室激活（钥匙）
|
||
//vobc.DirectionForward = message.IsTrueForByte(direction1) //方向手柄进位
|
||
//vobc.DirectionBackward = message.IsTrueForByte(direction2) //方向手柄退位
|
||
buf := data[0]
|
||
vobc.Tc1Active = message.IsTrueForByte(message.GetBit(buf, 0)) //本端驾驶室激活（钥匙）
|
||
vobc.DirectionForward = message.IsTrueForByte(message.GetBit(buf, 1)) //方向手柄进位
|
||
vobc.DirectionBackward = message.IsTrueForByte(message.GetBit(buf, 2)) //方向手柄退位
|
||
}
|
||
|
||
// 创建/删除列车
|
||
func (s *VerifySimulation) TrainPcSimConnOrRemoveHandle(state byte) {
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("创建删除列车，未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
connState := train.ConnState
|
||
if state == 0x01 {
|
||
connState.Conn = true
|
||
} else {
|
||
connState.Conn = false
|
||
}
|
||
train_pc_sim.Default().CreateOrRemoveSpeedPLace(train)
|
||
}
|
||
|
||
// 门模式
|
||
func (s *VerifySimulation) TrainDoorModeHandle(state byte) {
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("车载pc仿真门模式，未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
if !train.ConnState.Conn {
|
||
slog.Error("车载pc仿真门模式,列车未连接车载pc仿真")
|
||
return
|
||
}
|
||
switch state {
|
||
case 0x00:
|
||
//0x00表示自开自关（AA）
|
||
train.VobcState.DoorModeAA = true
|
||
case 0x01:
|
||
//0x01表示自开人关（AM）
|
||
train.VobcState.DoorModeAM = true
|
||
case 0x02:
|
||
//0x02表示人开人关（MM）
|
||
train.VobcState.DoorModeMM = true
|
||
}
|
||
}
|
||
|
||
// 4.4.3. 车载输出模拟量信息报文内容(0x03)
|
||
func (s *VerifySimulation) TrainPcSimMockInfo(data []byte) {
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("车载输出模拟量,未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
if !train.ConnState.Conn {
|
||
slog.Error("车载输出模拟量,列车未连接车载pc仿真")
|
||
return
|
||
}
|
||
mockData := binary.BigEndian.Uint16(data)
|
||
train.VobcState.MockInfo = uint32(mockData)
|
||
}
|
||
|
||
// 4.4.4. 车载输出BTM查询同步帧报文内容（0x04）
|
||
func (s *VerifySimulation) TrainBtmQuery(data []byte) {
|
||
if len(data) < 12 {
|
||
slog.Error("列车btm查询报文长度错误:", len(data))
|
||
return
|
||
}
|
||
train := s.findConnTrain(state_proto.TrainConnState_PC_SIM)
|
||
if train == nil {
|
||
slog.Error("车载输出btm查询,未找到连接车载pc仿真的列车")
|
||
return
|
||
}
|
||
if !train.ConnState.Conn {
|
||
slog.Error("车载输出btm查询,列车未连接车载pc仿真")
|
||
return
|
||
}
|
||
|
||
trainAtm := message.NewCanetFrame(data, true)
|
||
atpReq := &message.AtpRequestFrame{}
|
||
if !atpReq.Decode(trainAtm) {
|
||
slog.Warn("列车pc驾驶模拟-CanetFrame解码成AtpRequestFrame失败", "CanetFrame", trainAtm.String())
|
||
return
|
||
}
|
||
cl := clock(atpReq)
|
||
btmRepFrame := createBtmStatus(trainAtm.CanId.ID4, train.BtmState, atpReq, cl)
|
||
if atpReq.ResendRequest == 2 {
|
||
//重新发送
|
||
if len(train.BtmState.BaliseTelegramForPcSimResend) > 0 {
|
||
dd, _ := hex.DecodeString(train.BtmState.BaliseTelegramForPcSimResend)
|
||
train_pc_sim.Default().SendBaliseData(train_pc_sim.RECIVE_TRAIN_BTM_HAS_DATA, dd)
|
||
}
|
||
} else {
|
||
timeSyncF := message.NewBtmTimeSyncCheckFrame(trainAtm.CanId.ID4, true)
|
||
timeSyncF.T2 = cl.BtmTk
|
||
timeSyncF.T3 = cl.TkNow()
|
||
telCount := strings.Count(train.BtmState.Telegram, "00")
|
||
if telCount >= balise_const.UserTelegramByteLen {
|
||
//无数据
|
||
queryData := make([]byte, 0)
|
||
queryData = append(queryData, btmRepFrame.Encode().Encode()...)
|
||
queryData = append(queryData, timeSyncF.Encode().Encode()...)
|
||
train_pc_sim.Default().SendBaliseData(train_pc_sim.RECIVE_TRAIN_BTM_NOT_DATA, queryData)
|
||
} else {
|
||
//有数据
|
||
aliseData, _ := hex.DecodeString(train.BtmState.Telegram)
|
||
statusDataCf, statusDataCfOk := message.CreateBtmRspFramesData(btmRepFrame, aliseData, false, cl.TkNow(), cl.TkNow(), cl.TkNow(), true)
|
||
if statusDataCfOk {
|
||
queryData := make([]byte, 0)
|
||
queryData = append(queryData, btmRepFrame.Encode().Encode()...)
|
||
queryData = append(queryData, timeSyncF.Encode().Encode()...)
|
||
queryData = append(queryData, statusDataCf...) //数据帧包含结束帧
|
||
train.BtmState.BaliseTelegramForPcSimResend = fmt.Sprintf("%X", statusDataCf)
|
||
train_pc_sim.Default().SendBaliseData(train_pc_sim.RECIVE_TRAIN_BTM_HAS_DATA, queryData)
|
||
} else {
|
||
slog.Error("列车pc仿真 BtmCanetClient应答帧、数据帧编码失败")
|
||
}
|
||
}
|
||
}
|
||
}
|
||
|
||
func createBtmStatus(canIdSn byte, btmState *state_proto.BTMState, atpReq *message.AtpRequestFrame, cl can_btm.BtmClock) *message.BtmStatusRspFrame {
|
||
statusF := message.NewBtmStatusRspFrame(canIdSn, true)
|
||
//btmStatus := aa(train, atpReq)
|
||
|
||
statusF.PowerAmplifierOn = true
|
||
statusF.PowerAmplifierFailure = false
|
||
statusF.AtpReqCrcCheckWrong = !atpReq.Crc16CheckOk
|
||
statusF.AntennaFault = false
|
||
statusF.BaliseCounter = byte(btmState.BaliseCount)
|
||
statusF.MessageCounter = byte(btmState.MessageCounter)
|
||
statusF.TkTimeA = cl.TkNow()
|
||
statusF.DetailedCode = 0
|
||
if btmState.AboveBalise {
|
||
statusF.DetailedCode = 0x07
|
||
}
|
||
statusF.Dsn = byte(btmState.DataSerialNumber)
|
||
return statusF
|
||
}
|
||
|
||
func clock(atpReq *message.AtpRequestFrame) can_btm.BtmClock {
|
||
now := time.Now()
|
||
return can_btm.BtmClock{BtmTk: atpReq.Time, SysTk: now}
|
||
}
|