kservo(rds3115)

C++ implementation

struct State {
};

{{ GENERATED_CODE }}

void evaluate(Context ctx) 
{
    if (isInputDirty<input_UPD>(ctx))
    {
        const uint8_t port = getValue<input_PORT>(ctx);

        Number degree = getValue<input_DEG>(ctx);

        Number maxdeg = getValue<input_MAX>(ctx);

        if (isValidDigitalPort(port) && degree>=0 && degree<=maxdeg)
        {
             uint32_t pwm = uint32_t((degree*(2000)/maxdeg) + 500);
             ::digitalWrite(port, 1);
             delayMicroseconds(pwm);
             ::digitalWrite(port, 0);
             delayMicroseconds(20000-pwm);

             emitValue<output_DONE>(ctx, 1);
        }
        else
            emitValue<output_ERR>(ctx, 1);
    }
}