From 119bc4f0914e9fcb3f92fc4aa4007f881f44228a Mon Sep 17 00:00:00 2001
From: lulko <keklolov7@gmail.com>
Date: Fri, 28 Feb 2025 10:08:55 +0300
Subject: [PATCH] =?UTF-8?q?=D0=94=D0=BE=D0=B1=D0=B0=D0=B2=D0=B8=D0=BB=20?=
 =?UTF-8?q?=D1=82=D0=B5=D1=81=D1=82=20=D0=B4=D0=BB=D1=8F=20=D0=B7=D0=B0?=
 =?UTF-8?q?=D0=BF=D0=B8=D1=81=D0=B8=20=D0=B8=20=D0=BE=D0=B4=D0=BD=D0=BE?=
 =?UTF-8?q?=D0=B2=D1=80=D0=B5=D0=BC=D0=B5=D0=BD=D0=BD=D0=BE=20=D1=87=D1=82?=
 =?UTF-8?q?=D0=B5=D0=BD=D0=B8=D1=8F=20ID=20=D1=83=D1=81=D1=82=D1=80=D0=BE?=
 =?UTF-8?q?=D0=B9=D1=81=D1=82=D0=B2=D0=B0=20=D0=BF=D0=BE=20=20CAN?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 controller/fw/embed/test/python_test_id.py | 73 ++++++++++++++++++++++
 1 file changed, 73 insertions(+)
 create mode 100644 controller/fw/embed/test/python_test_id.py

diff --git a/controller/fw/embed/test/python_test_id.py b/controller/fw/embed/test/python_test_id.py
new file mode 100644
index 0000000..d59908c
--- /dev/null
+++ b/controller/fw/embed/test/python_test_id.py
@@ -0,0 +1,73 @@
+import can
+import time
+
+def send_write_read_requests():
+    try:
+        bus = can.interface.Bus(channel='can0', bustype='socketcan')
+
+        # Конфигурация сообщений (ЗАПОЛНИТЕ ВАШИ ЗНАЧЕНИЯ)
+        write_msg = {
+            'arbitration_id': 0x01,          # CAN ID для записи 
+            'data': [0xA0, 0x69, 0x00, 0x00], # Данные для записи (4 байта)
+            'description': "Установка id устройства"
+        }
+
+        read_msg = {
+            'arbitration_id': 0x01,          # CAN ID для чтения
+            'data': [0x99],                   # Команда запроса данных
+            'description': "Запрос id устройства",
+            'response_id': 0x69,             # Ожидаемый ID ответа
+            'timeout': 1.0                    # Таймаут ожидания ответа (сек)
+        }
+
+        # 1. Отправка команды записи
+        print("Отправка команды записи...")
+        msg = can.Message(
+            arbitration_id=write_msg['arbitration_id'],
+            data=write_msg['data'],
+            is_extended_id=False
+        )
+        bus.send(msg)
+        print(f"Запись: ID={hex(msg.arbitration_id)}, Данные={list(msg.data)}")
+        
+        # Ждем обработки команды устройством
+        time.sleep(1.5)  
+
+        # 2. Отправка запроса чтения и ожидание ответа
+        print("\nОтправка запроса чтения...")
+        msg = can.Message(
+            arbitration_id=read_msg['arbitration_id'],
+            data=read_msg['data'],
+            is_extended_id=False
+        )
+        bus.send(msg)
+        print(f"Чтение: ID={hex(msg.arbitration_id)}, Команда={list(msg.data)}")
+
+        # Ожидаем ответа
+        start_time = time.time()
+        response_received = False
+        
+        print("\nОжидание ответа...")
+        while (time.time() - start_time) < read_msg['timeout']:
+            response = bus.recv(timeout=0.1)
+            
+            if response and response.arbitration_id == read_msg['response_id']:
+                print(f"\nПолучен ответ: ID={hex(response.arbitration_id)}")
+                print(f"Данные: {list(response.data)}")
+                print(f"Длина: {response.dlc} байт")
+                response_received = True
+                break
+        
+        if not response_received:
+            print("\nОшибка: ответ не получен в течение заданного времени")
+
+    except KeyboardInterrupt:
+        print("\nПрерывание пользователем")
+    except Exception as e:
+        print(f"Ошибка: {str(e)}")
+    finally:
+        bus.shutdown()
+        print("\nCAN соединение закрыто")
+
+if __name__ == '__main__':
+    send_write_read_requests()