esp_fy6800.cpp

#include "esp_fy6800.h"
#include <string.h>

volatile SDeviceState gDeviceState;

void fy6800_write(char* data, uint8_t len)
{
    uint32_t timeout = 0;
    Serial.write((uint8_t*)data, len);
    while(0 == Serial.available())
    {
        delay(1);
        if(timeout++>1000) return;
    }
    (void)Serial.read();
}

void setCh1Wave(EWaveType wave)
{
    char command[] = "WMW00\n";
    snprintf(command, 7, "WMW%02u\n", wave);
    gDeviceState.ch1Wave = wave;
    fy6800_write(command, 6);
}

void setCh2Wave(EWaveType wave)
{
    char command[] = "WFW00\n";
    snprintf(command, 7, "WFW%02u\n", wave);
    gDeviceState.ch2Wave = wave;
    fy6800_write(command, 6);
}

void setCh1Output(uint32_t output)
{
    if(output)
    {
        gDeviceState.ch1Output = 1;
        fy6800_write("WMN1\n", 5);
    }
    else
    {
        gDeviceState.ch1Output = 0;
        fy6800_write("WMN0\n", 5);
    }
}

void setCh2Output(uint32_t output)
{
    if(output)
    {
        gDeviceState.ch2Output = 1;
        fy6800_write("WFN1\n", 5);
    }
    else
    {
        gDeviceState.ch2Output = 0;
        fy6800_write("WFN0\n", 5);
    }
}

/* Set frequency in Hz */
void setCh1Freq(uint32_t frequency)
{
    char command[] = "WMF00000000000000\n";
    snprintf(command, 19, "WMF%08lu000000\n", frequency);
    gDeviceState.ch1Freq = frequency;
    fy6800_write(command, 18);
}

/* Set frequency in Hz */
void setCh2Freq(uint32_t frequency)
{
    char command[] = "WFF00000000000000\n";
    snprintf(command, 19, "WFF%08lu000000\n", frequency);
    gDeviceState.ch2Freq = frequency;
    fy6800_write(command, 18);
}

/* Ampl is in mV: 12.345V = 12345 */
void setCh1Ampl(uint32_t ampl)
{
    char command[] = "WMA00.000\n";
    snprintf(command, 11, "WMA%02u.%03u\n", ampl/1000, ampl%1000);
    gDeviceState.ch1Ampl = ampl;
    fy6800_write(command, 10);
}

void setCh2Ampl(uint32_t ampl)
{
    char command[] = "WFA00.000\n";
    snprintf(command, 11, "WFA%02u.%03u\n", ampl/1000, ampl%1000);
    gDeviceState.ch2Ampl = ampl;
    fy6800_write(command, 10);
}

/* Phase is in 0.1deg: 12.5deg = 125 */
void setCh1Phase(uint32_t phase)
{
    char command[] = "WMA00.000\n";
    snprintf(command, 11, "WMP%02u.%01u\n", phase/1000, (phase%1000)/100);
    gDeviceState.ch1Phase = phase;
    fy6800_write(command, 10);
}

void setCh2Phase(uint32_t phase)
{
    char command[] = "WFA00.000\n";
    snprintf(command, 11, "WFP%02u.%01u\n", phase/1000, (phase%1000)/100);
    gDeviceState.ch2Phase = phase;
    fy6800_write(command, 10);
}

void setCh1Offset(int32_t offset)
{
    char command[] = "WMO00.000\n";
    gDeviceState.ch1Offset = offset;
    if(offset>=0)
    {
        snprintf(command, 11, "WMO%02u.%03u\n", offset/1000, offset%1000);
        fy6800_write(command, 10);
    }
    else
    {
        snprintf(command, 12, "WMO-%02u.%03u\n", -offset/1000, -offset%1000);
        fy6800_write(command, 11);
    }
}

void setCh2Offset(int32_t offset)
{
    char command[] = "WFO00.000\n";
    gDeviceState.ch2Offset = offset;
    if(offset>=0)
    {
        snprintf(command, 11, "WFO%02u.%03u\n", offset/1000, offset%1000);
        fy6800_write(command, 10);
    }
    else
    {
       snprintf(command, 12, "WFO-%02u.%03u\n", -offset/1000, -offset%1000);
       fy6800_write(command, 11);
   }
}

void initDevice(void)
{
    Serial.write((uint8_t*)"\n", 1);

    setCh1Output(0);
    setCh1Wave(EWaveType_Sine);
    setCh1Freq(1000);
    setCh1Ampl(1000);
    setCh1Offset(0);

    setCh2Output(0);
    setCh2Wave(EWaveType_Sine);
    setCh2Freq(1000);
    setCh2Ampl(1000);
    setCh2Offset(0);

}