#include "stm32f4xx_flash.h"
#include "stm32f4xx.h"
#include "modbus.h"
#include "modbus_flash.h"
#include "string.h"
#include "os.h"

extern uint8_t ModbusCoil[1250];  
extern uint16_t ModbusReg[10000];
extern uint8_t ModbusErr;

extern OS_EVENT* ModbusWriteFlash;      /*接收到modbus写入coil请求报文*/

uint8_t ModbusFlashWrite(void);
uint8_t ModbusErrReply(uint8_t func, uint8_t err);


void AppTaskModbusWriteFlash(void *p_arg)
{
    OS_ERR err;
    while(1)
    {
        OSSemPend(ModbusWriteFlash, 0, &err);
        OSTimeDly(OS_TICKS_PER_SEC); 
        while (USART_GetFlagStatus(USART1, USART_FLAG_TC) == RESET);

        ModbusErr = ModbusFlashWrite();
    }
}


uint8_t ModbusFlashWrite(void)
{
    uint32_t addres = MODBUS_FLASH_COIL_ADDR;
    uint16_t halfWord;
    FLASH_Status status;

    FLASH_Unlock();
    FLASH_ClearFlag(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR 
                     | FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR);

    /*扇区擦除，写入之前必须先擦除*/
    status = FLASH_EraseSector(MODBUS_FLASH_SECTOR, VoltageRange_3);

    if(status != FLASH_COMPLETE)
    {
        return ERR_SLAVE;
    }

    for(uint16_t i = 0; i < 1250; i += 2)
    {
        /*前面的放在低字节，后面的放在高字节*/
        halfWord =  ((uint16_t)ModbusCoil[i + 1] << 8) | ((uint16_t)ModbusCoil[i]);

        status = FLASH_ProgramHalfWord(addres, halfWord);

        /*写入失败，停止写入*/
        if(status != FLASH_COMPLETE)
        {
            return ERR_SLAVE;
        }

        addres += 2;
    }
    addres = MODBUS_FLASH_REG_ADDR;
    for(uint16_t i = 0; i < 10000; i++)
    {
        status = FLASH_ProgramHalfWord(addres, ModbusReg[i]);

        /*写入失败，停止写入*/
        if(status != FLASH_COMPLETE)
        {
            return ERR_SLAVE;
        }

        addres += 2;
    }
    FLASH_Lock();
    return 0;
}



void ModbusRegReadFlash(void)
{
    memcpy(ModbusReg, (const void *)MODBUS_FLASH_REG_ADDR, sizeof(ModbusReg));
}

void ModbusCoilReadFlash(void)
{
    memcpy(ModbusCoil, (const void *)MODBUS_FLASH_COIL_ADDR, sizeof(ModbusCoil));
}