rts-sim-testing-service/third_party/semi_physical_train/semi_physical_train.go
tiger_zhou ff67c84f18
All checks were successful
local-test分支打包构建docker并发布运行 / Docker-Build (push) Successful in 4m7s
列车控制连接多车调整,连接状态显示调整
2024-07-19 15:24:28 +08:00

141 lines
3.8 KiB
Go

package semi_physical_train
import (
"fmt"
"sync"
"joylink.club/bj-rtsts-server/config"
"joylink.club/bj-rtsts-server/third_party/message"
"joylink.club/bj-rtsts-server/third_party/tpapi"
"joylink.club/bj-rtsts-server/third_party/udp"
)
// 半实物仿真列车通信接口
type SemiPhysicalTrain interface {
tpapi.ThirdPartyApiService
// 启动半实物仿真消息处理
Start(manager SemiPhysicalMessageManager)
// 停止半实物仿真消息处理
Stop()
// 发送列车控制消息
SendTrainControlMessage(info *message.DynamicsTrainInfo)
}
type SemiPhysicalMessageManager interface {
// 处理半实物仿真列车控制消息
HandleSemiPhysicalTrainControlMsg(b []byte)
// 获取半实物启动参数
GetSemiPhysicalRunConfig() *config.VobcConfig
}
type semiPhysicalTrainImpl struct {
tpapi.ThirdPartyApiService
trainControlUdpServer udp.UdpServer
trainSpeedInfoUdpClient udp.UdpClient
state tpapi.ThirdPartyApiServiceState
udpDelayRecorder *tpapi.UdpDelayRecorder
manager SemiPhysicalMessageManager
runConfig *config.VobcConfig
}
func (s *semiPhysicalTrainImpl) updateState(state tpapi.ThirdPartyApiServiceState) {
s.state = state
}
func (s *semiPhysicalTrainImpl) State() tpapi.ThirdPartyApiServiceState {
return s.state
}
func (s *semiPhysicalTrainImpl) Name() string {
return Name
}
func (d *semiPhysicalTrainImpl) FindAppendApiService() []tpapi.ThirdPartyApiService {
return nil
}
func (d *semiPhysicalTrainImpl) TrueService() bool {
return true
}
func (d *semiPhysicalTrainImpl) ServiceDesc() string {
return Name
}
func (s *semiPhysicalTrainImpl) handleTrainControlMsg(b []byte) {
s.udpDelayRecorder.RecordInterval()
// slog.Debug(fmt.Sprintf("半实物列车控制消息近期消息间隔: %v", s.udpDelayRecorder.GetIntervals()))
handler := s.manager
if handler != nil {
handler.HandleSemiPhysicalTrainControlMsg(b)
}
}
func (s *semiPhysicalTrainImpl) Start(manager SemiPhysicalMessageManager) {
if s.runConfig == nil || s.runConfig.Ip == "" || !s.runConfig.Open {
return
}
if manager == nil {
panic("启动半实物消息服务错误: SemiPhysicalMessageManager不能为nil")
}
if s.manager != nil {
panic("启动半实物消息服务错误: 存在正在运行的任务")
}
s.runConfig = manager.GetSemiPhysicalRunConfig()
// 初始化客户端、服务端
s.initSemiPhysical()
s.updateState(tpapi.ThirdPartyState_Normal)
s.udpDelayRecorder.Start()
s.manager = manager
}
func (s *semiPhysicalTrainImpl) Stop() {
initMutex.Lock()
defer initMutex.Unlock()
s.udpDelayRecorder.Stop()
if s.trainControlUdpServer != nil {
s.trainControlUdpServer.Close()
}
if s.trainSpeedInfoUdpClient != nil {
s.trainSpeedInfoUdpClient.Close()
}
s.manager = nil
s.updateState(tpapi.ThirdPartyState_Closed)
}
func (s *semiPhysicalTrainImpl) SendTrainControlMessage(info *message.DynamicsTrainInfo) {
if s.trainSpeedInfoUdpClient != nil {
sendMsg := &message.TrainSpeedMsg{}
sendMsg.DynamicsDecode(info)
s.trainSpeedInfoUdpClient.Send(sendMsg.Encode())
}
}
func (s *semiPhysicalTrainImpl) initSemiPhysical() {
s.trainSpeedInfoUdpClient = udp.NewClient(fmt.Sprintf("%v:%v", s.runConfig.Ip, s.runConfig.RemotePort))
s.trainControlUdpServer = udp.NewServer(fmt.Sprintf(":%d", s.runConfig.LocalPort), s.handleTrainControlMsg)
s.trainControlUdpServer.Listen()
}
var _default *semiPhysicalTrainImpl
var initMutex sync.Mutex
const Name = "半实物仿真列车"
const Interval int = 20
func Default() SemiPhysicalTrain {
initMutex.Lock()
defer initMutex.Unlock()
if _default == nil {
_default = &semiPhysicalTrainImpl{
udpDelayRecorder: tpapi.NewUdpDelayRecorder(Interval, func(err error) {
if err != nil {
_default.updateState(tpapi.ThirdPartyState_Broken)
} else {
_default.updateState(tpapi.ThirdPartyState_Normal)
}
}),
}
}
return _default
}