package plc
|
|
import (
|
"errors"
|
"fmt"
|
apiModel "github.com/apache/plc4x/plc4go/pkg/api/model"
|
"github.com/apache/plc4x/plc4go/spi/options"
|
"sync"
|
"time"
|
|
plc4go "github.com/apache/plc4x/plc4go/pkg/api"
|
"github.com/apache/plc4x/plc4go/pkg/api/drivers"
|
"github.com/apache/plc4x/plc4go/pkg/api/transports"
|
)
|
|
type ConnectionManager struct {
|
connections map[string]plc4go.PlcConnection
|
mu sync.Mutex
|
}
|
|
func NewPlcConnectionManager() *ConnectionManager {
|
return &ConnectionManager{
|
connections: make(map[string]plc4go.PlcConnection),
|
}
|
}
|
|
func (cm *ConnectionManager) GetConnection(address string) (plc4go.PlcConnection, bool) {
|
cm.mu.Lock()
|
defer cm.mu.Unlock()
|
|
conn, ok := cm.connections[address]
|
return conn, ok
|
}
|
|
var connectionManager = NewPlcConnectionManager()
|
|
func (cm *ConnectionManager) AddConnection(address string, connection plc4go.PlcConnection) {
|
cm.mu.Lock()
|
defer cm.mu.Unlock()
|
|
cm.connections[address] = connection
|
}
|
func GetModbusConnection(ipAddr string) (plc4go.PlcConnection, error) {
|
if conn, ok := connectionManager.GetConnection(ipAddr); ok {
|
if conn.IsConnected() {
|
return conn, nil
|
}
|
}
|
|
// 创建驱动管理器
|
option := options.WithReceiveTimeout(time.Second * 5) //五秒超时
|
driverManager := plc4go.NewPlcDriverManager(option)
|
// 注册TCP传输
|
transports.RegisterTcpTransport(driverManager)
|
|
// 注册驱动
|
//drivers.RegisterKnxDriver(driverManager)
|
drivers.RegisterModbusTcpDriver(driverManager)
|
|
// 通过TCP连接PLC设备
|
connectionString := fmt.Sprintf("modbus-tcp://%s", ipAddr)
|
connectionRequestChanel := driverManager.GetConnection(connectionString)
|
|
// 等待连接响应
|
connectionResult := <-connectionRequestChanel
|
|
// 判断是否连接成功
|
if err := connectionResult.GetErr(); err != nil {
|
return nil, err
|
}
|
|
conn := connectionResult.GetConnection()
|
connectionManager.AddConnection(ipAddr, conn)
|
return conn, nil
|
}
|
func ReadHoldingRegisterSingle(connection plc4go.PlcConnection, address int) ([]byte, error) {
|
tagAddress := fmt.Sprintf("holding-register:%d:UINT", address)
|
|
// 读模式
|
readRequest, err := connection.ReadRequestBuilder().AddTagAddress("tag", tagAddress).Build()
|
if err != nil {
|
fmt.Printf("preparing read-request:%s\n", err.Error())
|
return nil, err
|
}
|
|
// 执行
|
readResult := <-readRequest.Execute()
|
if err := readResult.GetErr(); err != nil {
|
fmt.Printf("execting read-request:%s\n", err.Error())
|
return nil, err
|
}
|
|
// 判断响应码是否正确
|
if readResult.GetResponse().GetResponseCode("tag") != apiModel.PlcResponseCode_OK {
|
fmt.Printf("error an non-ok return code: %s", readResult.GetResponse().GetResponseCode("tag").GetName())
|
return nil, nil
|
}
|
|
value := readResult.GetResponse().GetValue("tag")
|
|
return value.GetRaw(), err
|
|
}
|
|
func ReadHoldingRegisterList(connection plc4go.PlcConnection, address, length int) ([]byte, error) {
|
tagAddress := fmt.Sprintf("holding-register:%d:UINT[%d]", address, length)
|
|
// 读模式
|
readRequest, err := connection.ReadRequestBuilder().AddTagAddress("tag", tagAddress).Build()
|
if err != nil {
|
fmt.Printf("preparing read-request:%s\n", err.Error())
|
return nil, err
|
}
|
|
// 执行
|
readResult := <-readRequest.Execute()
|
if err := readResult.GetErr(); err != nil {
|
fmt.Printf("execting read-request:%s\n", err.Error())
|
return nil, err
|
}
|
|
// 判断响应码是否正确
|
if readResult.GetResponse().GetResponseCode("tag") != apiModel.PlcResponseCode_OK {
|
fmt.Printf("error an non-ok return code: %s", readResult.GetResponse().GetResponseCode("tag").GetName())
|
return nil, errors.New("error code: " + readResult.GetResponse().GetResponseCode("tag").GetName())
|
}
|
|
value := readResult.GetResponse().GetValue("tag")
|
|
var result []byte
|
|
for _, val := range value.GetList() {
|
result = append(result, val.GetRaw()...)
|
}
|
|
return result, nil
|
}
|
|
func ReadHoldingRegister(connection plc4go.PlcConnection, address, length int) ([]byte, error) {
|
if length > 1 {
|
return ReadHoldingRegisterList(connection, address, length)
|
}
|
|
return ReadHoldingRegisterSingle(connection, address)
|
}
|
|
func WriteHoldingRegister(connection plc4go.PlcConnection, address int, value any) (string, error) {
|
tagAddress := fmt.Sprintf("holding-register:%d:UINT", address)
|
|
// 写模式
|
writeRequest, err := connection.WriteRequestBuilder().AddTagAddress("tag", tagAddress, value).Build()
|
if err != nil {
|
fmt.Printf("preparing read-request:%s\n", err.Error())
|
return "", err
|
}
|
|
// 执行
|
writeResult := <-writeRequest.Execute()
|
if err := writeResult.GetErr(); err != nil {
|
fmt.Printf("execting read-request:%s\n", err.Error())
|
return "", err
|
}
|
|
// 判断响应码是否正确
|
if writeResult.GetResponse().GetResponseCode("tag") != apiModel.PlcResponseCode_OK {
|
fmt.Printf("error an non-ok return code: %s", writeResult.GetResponse().GetResponseCode("tag").GetName())
|
return "", errors.New("error code: " + writeResult.GetResponse().GetResponseCode("tag").GetName())
|
}
|
|
result := writeResult.GetResponse().String()
|
|
return result, nil
|
}
|
