#include "MagS.h"
#include <iostream>
#include <cstring>
#include <chrono>
#include <thread>

int main() {
    // 初始化能源管理服务
    MagS_init(0, "Mag_Service");

    // 测试数据: 0x55, 0xAA, 0x55, 0xAA
    uint8_t test_data[] = {0x55, 0xAA, 0x55, 0xAA};
    uint16_t data_len = sizeof(test_data);
    
    std::string dest = "Com_Service";
    
    int count = 0;
    while (true) {
        count++;

        // 发送遥控数据
        MagS_telemetry_Pub(test_data, dest, data_len);
        
        std::this_thread::sleep_for(std::chrono::seconds(3));
    }
    
    return 0;
}