#include "plsr_self_test.h"
#include "plc_device.h"
#include "plsr_core.h"
#include "plsr_job.h"
#include <string.h>

/* 上电自测（验证后可删除）：
 * - 方向端子设为 Y4（SFD906=4），其余用出厂默认参数（K1）
 * - 任务：Q0 发 3 段脉冲（H00 完成，顺序衔接），同时验证段间跳转：
 *   段1：2000Hz / 1000 脉冲（已单段验证）
 *   段2：5000Hz / 6000 脉冲（加速 500ms + 匀速 200ms + 减速 500ms）
 *   段3：1000Hz / 500 脉冲
 * 数据源为静态数组，仅自测使用（正式 D 设备适配器见 Modbus 阶段）。 */

#define SELF_TEST_WORD_CAPACITY     (64U)
#define SELF_TEST_S0_BASE           (10U)
#define SELF_TEST_S1_BASE           (60U)
#define SELF_TEST_DIR_POINT         (4U)

static uint16_t SelfTestWords[3][SELF_TEST_WORD_CAPACITY];

static uint8_t SelfTestValidateWords(void *context,
                                     PLSR_DEVICE_TYPE device,
                                     uint32_t firstAddress,
                                     uint32_t wordCount)
{
    (void)context;
    if ((device > PLSR_DEVICE_FD) || (wordCount == 0UL))
    {
        return 0U;
    }
    return (((uint64_t)firstAddress + wordCount)
            <= SELF_TEST_WORD_CAPACITY)
               ? 1U
               : 0U;
}

static uint8_t SelfTestReadWord(void *context,
                                PLSR_DEVICE_TYPE device,
                                uint32_t address,
                                uint16_t *value)
{
    (void)context;
    if ((device > PLSR_DEVICE_FD) || (value == NULL)
        || (address >= SELF_TEST_WORD_CAPACITY))
    {
        return 0U;
    }
    *value = SelfTestWords[device][address];
    return 1U;
}

static uint8_t SelfTestReadBit(void *context,
                               PLSR_DEVICE_TYPE device,
                               uint32_t address,
                               uint8_t *value)
{
    (void)context;
    (void)device;
    (void)address;
    *value = 0U;
    return 1U;
}

static void SelfTestWriteDword(PLSR_DEVICE_TYPE device,
                               uint32_t address,
                               uint32_t value)
{
    SelfTestWords[device][address] = (uint16_t)(value & 0xFFFFUL);
    SelfTestWords[device][address + 1UL] = (uint16_t)(value >> 16U);
}

PLSR_RESULT PlsrSelfTestQueue(void)
{
    PLSR_CALL call;

    (void)memset(SelfTestWords, 0, sizeof(SelfTestWords));

    /* 方向端子 Y4（PULSE/DIR 模式必需，接线参数）。 */
    (void)PlcDeviceWriteSfd(906U, SELF_TEST_DIR_POINT);

    /* S0：3 段，H00 完成，顺序跳转。 */
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE, 3U);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 10U, 2000UL);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 12U, 1000UL);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 20U, 5000UL);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 22U, 6000UL);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 30U, 1000UL);
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S0_BASE + 32U, 500UL);

    /* S1：相对模式，起始段 0（=段1）。 */
    SelfTestWriteDword(PLSR_DEVICE_D, SELF_TEST_S1_BASE, 0U);

    (void)memset(&call, 0, sizeof(call));
    call.sequence = 0xA5A5UL;
    call.source.context = NULL;
    call.source.validateWords = SelfTestValidateWords;
    call.source.readWord = SelfTestReadWord;
    call.source.readBit = SelfTestReadBit;
    call.s0.device = PLSR_DEVICE_D;
    call.s0.address = SELF_TEST_S0_BASE;
    call.s1.device = PLSR_DEVICE_D;
    call.s1.address = SELF_TEST_S1_BASE;
    call.s2.type = PLSR_OPERAND_CONSTANT;
    call.s2.constant = 1;
    call.dAxis = 0U;
    call.outputModeOverride = PLSR_OUTPUT_MODE_FROM_SFD;
    return PlsrPostCall(&call);
}