405 lines
15 KiB
Python
405 lines
15 KiB
Python
import socket
|
||
import struct
|
||
import time
|
||
import threading
|
||
import logging
|
||
from enum import Enum
|
||
from typing import Optional, Callable
|
||
|
||
class FinsServiceStatus(Enum):
|
||
"""服务状态枚举"""
|
||
DISCONNECTED = "未连接"
|
||
CONNECTING = "连接中"
|
||
CONNECTED = "已连接"
|
||
POLLING = "轮询中"
|
||
ERROR = "错误"
|
||
STOPPED = "已停止"
|
||
|
||
class FinsPoolFullError(Exception):
|
||
"""连接池已满异常"""
|
||
pass
|
||
|
||
class OmronFinsPollingService:
|
||
"""欧姆龙FINS协议数据轮询服务（严格三指令版本）"""
|
||
|
||
def __init__(self, plc_ip: str, plc_port: int = 9600):
|
||
"""
|
||
初始化FINS服务
|
||
|
||
Args:
|
||
plc_ip: PLC IP地址
|
||
plc_port: PLC端口，默认9600
|
||
"""
|
||
self.plc_ip = plc_ip
|
||
self.plc_port = plc_port
|
||
|
||
# 服务状态
|
||
self._status = FinsServiceStatus.DISCONNECTED
|
||
self._socket: Optional[socket.socket] = None
|
||
|
||
# 轮询控制
|
||
self._polling_thread: Optional[threading.Thread] = None
|
||
self._stop_event = threading.Event()
|
||
self._polling_interval = 1.0
|
||
|
||
# 回调函数
|
||
self._data_callbacks = []
|
||
self._status_callbacks = []
|
||
|
||
# 最新数据
|
||
self._latest_data: Optional[int] = None
|
||
self._last_update_time: Optional[float] = None
|
||
|
||
# 配置日志
|
||
self._setup_logging()
|
||
|
||
def _setup_logging(self):
|
||
"""配置日志"""
|
||
logging.basicConfig(
|
||
level=logging.INFO,
|
||
format='%(asctime)s - %(name)s - %(levelname)s - %(message)s'
|
||
)
|
||
self.logger = logging.getLogger("FinsPollingService")
|
||
|
||
def _update_status(self, new_status: FinsServiceStatus, message: str = ""):
|
||
"""更新状态并触发回调"""
|
||
old_status = self._status
|
||
if old_status != new_status:
|
||
self._status = new_status
|
||
self.logger.info(f"状态变更: {old_status.value} -> {new_status.value} {message}")
|
||
|
||
for callback in self._status_callbacks:
|
||
try:
|
||
callback(old_status, new_status, message)
|
||
except Exception as e:
|
||
self.logger.error(f"状态回调执行失败: {e}")
|
||
|
||
def _send_and_receive(self, data: bytes, expected_length: int = 1024) -> bytes:
|
||
"""发送数据并接收响应"""
|
||
if not self._socket:
|
||
raise ConnectionError("Socket未连接")
|
||
|
||
print("_send_and_receive发送:",data)
|
||
self._socket.send(data)
|
||
response = self._socket.recv(expected_length)
|
||
return response
|
||
|
||
def _check_handshake_response(self, response: bytes):
|
||
"""检查握手响应"""
|
||
if len(response) < 24:
|
||
raise ConnectionError("握手响应数据不完整")
|
||
|
||
# 检查响应头
|
||
if response[0:4] != b'FINS':
|
||
raise ConnectionError("无效的FINS响应头")
|
||
|
||
# 检查命令代码
|
||
command_code = struct.unpack('>I', response[8:12])[0]
|
||
if command_code != 0x01:
|
||
raise ConnectionError(f"握手命令代码错误: 0x{command_code:08X}")
|
||
|
||
# 检查错误代码
|
||
error_code = struct.unpack('>I', response[12:16])[0]
|
||
if error_code == 0x20:
|
||
raise FinsPoolFullError("FINS连接池已满")
|
||
elif error_code != 0x00:
|
||
raise ConnectionError(f"握手错误代码: 0x{error_code:08X}")
|
||
|
||
self.logger.info("握手成功")
|
||
|
||
def _check_query_response(self, response: bytes) -> int:
|
||
"""检查查询响应并返回数据"""
|
||
if len(response) < 30:
|
||
raise ConnectionError("查询响应数据不完整")
|
||
|
||
# 检查响应头
|
||
if response[0:4] != b'FINS':
|
||
raise ConnectionError("无效的FINS响应头")
|
||
|
||
# 检查命令代码
|
||
command_code = struct.unpack('>I', response[8:12])[0]
|
||
if command_code != 0x02:
|
||
raise ConnectionError(f"查询命令代码错误: 0x{command_code:08X}")
|
||
|
||
# 检查错误代码
|
||
error_code = struct.unpack('>I', response[12:16])[0]
|
||
if error_code != 0x00:
|
||
raise ConnectionError(f"查询错误代码: 0x{error_code:08X}")
|
||
|
||
# 提取数据字节（最后一个字节）
|
||
data_byte = response[-1]
|
||
return data_byte
|
||
|
||
def _check_logout_response(self, response: bytes):
|
||
"""检查注销响应"""
|
||
if len(response) < 16:
|
||
raise ConnectionError("注销响应数据不完整")
|
||
|
||
# 检查响应头
|
||
if response[0:4] != b'FINS':
|
||
raise ConnectionError("无效的FINS响应头")
|
||
|
||
# 检查命令代码
|
||
command_code = struct.unpack('>I', response[8:12])[0]
|
||
if command_code != 0x03:
|
||
raise ConnectionError(f"注销命令代码错误: 0x{command_code:08X}")
|
||
|
||
# 检查错误代码
|
||
error_code = struct.unpack('>I', response[12:16])[0]
|
||
if error_code != 0x02:
|
||
raise ConnectionError(f"注销错误代码: 0x{error_code:08X}")
|
||
|
||
self.logger.info("注销成功")
|
||
|
||
def connect(self) -> bool:
|
||
"""
|
||
连接到PLC并完成握手
|
||
|
||
Returns:
|
||
bool: 连接是否成功
|
||
"""
|
||
if self._status == FinsServiceStatus.CONNECTED:
|
||
self.logger.warning("已经连接到PLC")
|
||
return True
|
||
|
||
self._update_status(FinsServiceStatus.CONNECTING, "开始连接PLC")
|
||
|
||
try:
|
||
# 创建socket连接
|
||
self._socket = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
|
||
self._socket.settimeout(10.0)
|
||
self._socket.connect((self.plc_ip, self.plc_port))
|
||
self.logger.info(f"TCP连接已建立: {self.plc_ip}:{self.plc_port}")
|
||
|
||
# 指令1: 握手
|
||
# 46 49 4E 53 00 00 00 0C 00 00 00 00 00 00 00 00 00 00 00 DC
|
||
handshake_cmd = bytes.fromhex("46 49 4E 53 00 00 00 0C 00 00 00 00 00 00 00 00 00 00 00 DC")
|
||
self.logger.debug("发送握手指令")
|
||
response = self._send_and_receive(handshake_cmd, 24)
|
||
|
||
# 检查握手响应
|
||
self._check_handshake_response(response)
|
||
|
||
self._update_status(FinsServiceStatus.CONNECTED, "握手成功")
|
||
return True
|
||
|
||
except FinsPoolFullError:
|
||
self._update_status(FinsServiceStatus.ERROR, "连接池已满")
|
||
raise
|
||
except Exception as e:
|
||
self._update_status(FinsServiceStatus.ERROR, f"连接失败: {e}")
|
||
if self._socket:
|
||
self._socket.close()
|
||
self._socket = None
|
||
raise
|
||
|
||
def query_data(self) -> Optional[int]:
|
||
"""
|
||
查询PLC数据
|
||
|
||
Returns:
|
||
int: 数据值(0-255)
|
||
"""
|
||
|
||
if self._status != FinsServiceStatus.POLLING:
|
||
raise ConnectionError("未连接到PLC，无法查询")
|
||
|
||
try:
|
||
# 指令2: 查询
|
||
# 46 49 4E 53 00 00 00 1A 00 00 00 02 00 00 00 00 80 00 30 00 E9 00 00 DC 00 00 01 01 B0 00 00 00 00 01
|
||
query_cmd = bytes.fromhex("46 49 4E 53 00 00 00 1A 00 00 00 02 00 00 00 00 80 00 30 00 E9 00 00 DC 00 00 01 01 B0 00 00 00 00 01")
|
||
self.logger.debug("发送查询指令")
|
||
response = self._send_and_receive(query_cmd, 1024)
|
||
|
||
# 检查查询响应并提取数据
|
||
data_byte = self._check_query_response(response)
|
||
|
||
self._latest_data = data_byte
|
||
self._last_update_time = time.time()
|
||
|
||
# 触发数据回调
|
||
binary_str = bin(data_byte)
|
||
for callback in self._data_callbacks:
|
||
try:
|
||
callback(data_byte, binary_str)
|
||
except Exception as e:
|
||
self.logger.error(f"数据回调执行失败: {e}")
|
||
|
||
self.logger.debug(f"查询成功: 数据=0x{data_byte:02X} ({binary_str})")
|
||
return data_byte
|
||
|
||
except Exception as e:
|
||
self.logger.error(f"查询失败: {e}")
|
||
raise
|
||
|
||
def disconnect(self):
|
||
"""断开连接"""
|
||
if self._socket:
|
||
try:
|
||
# 指令3: 注销
|
||
# 46 49 4E 53 00 00 00 10 00 00 00 02 00 00 00 00 DC E9
|
||
logout_cmd = bytes.fromhex("46 49 4E 53 00 00 00 10 00 00 00 02 00 00 00 00 00 00 00 DC 00 00 00 E9")
|
||
self.logger.debug("发送注销指令")
|
||
response = self._send_and_receive(logout_cmd, 24)
|
||
|
||
# 检查注销响应
|
||
self._check_logout_response(response)
|
||
|
||
except Exception as e:
|
||
self.logger.error(f"注销过程中出错: {e}")
|
||
finally:
|
||
self._socket.close()
|
||
self._socket = None
|
||
|
||
self._update_status(FinsServiceStatus.DISCONNECTED, "连接已关闭")
|
||
|
||
def _polling_loop(self):
|
||
"""轮询循环"""
|
||
self.logger.info("数据轮询循环启动")
|
||
|
||
while not self._stop_event.is_set():
|
||
try:
|
||
if self._status == FinsServiceStatus.CONNECTED:
|
||
self._update_status(FinsServiceStatus.POLLING, "正在查询数据")
|
||
self.query_data()
|
||
self._update_status(FinsServiceStatus.CONNECTED, "查询完成")
|
||
else:
|
||
# 尝试重新连接
|
||
try:
|
||
self.connect()
|
||
except FinsPoolFullError:
|
||
self.logger.error("连接池已满，等待后重试...")
|
||
time.sleep(5)
|
||
except Exception as e:
|
||
self.logger.error(f"连接失败: {e}, 等待后重试...")
|
||
time.sleep(2)
|
||
|
||
except Exception as e:
|
||
self.logger.error(f"轮询查询失败: {e}")
|
||
self._update_status(FinsServiceStatus.ERROR, f"查询错误: {e}")
|
||
# 查询失败不影响连接状态，保持CONNECTED状态
|
||
self._update_status(FinsServiceStatus.CONNECTED, "准备下一次查询")
|
||
time.sleep(1)
|
||
|
||
# 等待轮询间隔
|
||
self._stop_event.wait(self._polling_interval)
|
||
|
||
self.logger.info("数据轮询循环停止")
|
||
|
||
def start_polling(self, interval: float = 1.0):
|
||
"""
|
||
启动数据轮询服务
|
||
|
||
Args:
|
||
interval: 轮询间隔(秒)
|
||
"""
|
||
if self._polling_thread and self._polling_thread.is_alive():
|
||
self.logger.warning("轮询服务已在运行")
|
||
return
|
||
|
||
self._polling_interval = interval
|
||
self._stop_event.clear()
|
||
|
||
# 先建立连接
|
||
try:
|
||
self.connect()
|
||
except Exception as e:
|
||
self.logger.error(f"初始连接失败: {e}")
|
||
# 继续启动轮询，轮询循环会尝试重连
|
||
|
||
# 启动轮询线程
|
||
self._polling_thread = threading.Thread(target=self._polling_loop, daemon=True)
|
||
self._polling_thread.start()
|
||
self.logger.info(f"数据轮询服务已启动，间隔: {interval}秒")
|
||
|
||
def stop_polling(self):
|
||
"""停止数据轮询服务"""
|
||
self.logger.info("正在停止数据轮询服务...")
|
||
self._stop_event.set()
|
||
|
||
if self._polling_thread and self._polling_thread.is_alive():
|
||
self._polling_thread.join(timeout=5.0)
|
||
|
||
self.disconnect()
|
||
self._update_status(FinsServiceStatus.STOPPED, "服务已停止")
|
||
self.logger.info("数据轮询服务已停止")
|
||
|
||
# === 公共接口 ===
|
||
|
||
def get_service_status(self) -> dict:
|
||
"""获取服务状态"""
|
||
return {
|
||
'status': self._status.value,
|
||
'is_connected': self._status == FinsServiceStatus.CONNECTED,
|
||
'is_polling': self._polling_thread and self._polling_thread.is_alive(),
|
||
'latest_data': self._latest_data,
|
||
'latest_data_binary': bin(self._latest_data) if self._latest_data is not None else None,
|
||
'last_update_time': self._last_update_time,
|
||
'plc_ip': self.plc_ip,
|
||
'plc_port': self.plc_port,
|
||
'polling_interval': self._polling_interval
|
||
}
|
||
|
||
def get_latest_data(self) -> Optional[int]:
|
||
"""获取最新数据"""
|
||
return self._latest_data
|
||
|
||
def get_latest_data_binary(self) -> Optional[str]:
|
||
"""获取最新数据的二进制表示"""
|
||
return bin(self._latest_data) if self._latest_data is not None else None
|
||
|
||
# === 回调注册接口 ===
|
||
|
||
def register_data_callback(self, callback: Callable[[int, str], None]):
|
||
"""注册数据更新回调"""
|
||
self._data_callbacks.append(callback)
|
||
|
||
def register_status_callback(self, callback: Callable[[FinsServiceStatus, FinsServiceStatus, str], None]):
|
||
"""注册状态变化回调"""
|
||
self._status_callbacks.append(callback)
|
||
|
||
def __enter__(self):
|
||
"""上下文管理器入口"""
|
||
return self
|
||
|
||
def __exit__(self, exc_type, exc_val, exc_tb):
|
||
"""上下文管理器出口，确保资源释放"""
|
||
self.stop_polling()
|
||
|
||
|
||
# 使用示例和测试
|
||
if __name__ == "__main__":
|
||
def on_data_update(data: int, binary: str):
|
||
#4即将振捣室5振捣室 64即将搅拌楼 66到达搅拌楼
|
||
print(f"[数据回调] 数值: 0x{data:02X} | 十进制: {data:3d} | 二进制: {binary}")
|
||
|
||
def on_status_change(old_status: FinsServiceStatus, new_status: FinsServiceStatus, message: str):
|
||
print(f"[状态回调] {old_status.value} -> {new_status.value} : {message}")
|
||
|
||
# 创建服务实例
|
||
service = OmronFinsPollingService("192.168.250.233") # 替换为实际PLC IP
|
||
|
||
# 注册回调
|
||
service.register_data_callback(on_data_update)
|
||
service.register_status_callback(on_status_change)
|
||
|
||
print("欧姆龙FINS数据轮询服务")
|
||
print("=" * 50)
|
||
|
||
try:
|
||
# 启动轮询服务，每2秒查询一次
|
||
service.start_polling(interval=2.0)
|
||
|
||
# 主循环，定期显示服务状态
|
||
counter = 0
|
||
while True:
|
||
status = service.get_service_status()
|
||
counter += 1
|
||
time.sleep(1)
|
||
|
||
except KeyboardInterrupt:
|
||
print("\n\n接收到Ctrl+C，正在停止服务...")
|
||
finally:
|
||
# 确保服务正确停止
|
||
service.stop_polling()
|
||
print("服务已安全停止") |