Easyelectronics.ru

#include "src/CMSIS_DAPusb/DAP.h"

extern volatile __xdata uint8_t USBByteCountEP1;

void setup() {
  USBInit();
}

void loop() {
  if (USBByteCountEP1) {
    DAP_Thread();
    USBByteCountEP1 = 0 ;

    UEP1_CTRL = UEP1_CTRL & ~ MASK_UEP_R_RES | UEP_R_RES_ACK; //enable receive

    UEP1_T_LEN = 64;
    UEP1_CTRL = UEP1_CTRL & ~ MASK_UEP_T_RES | UEP_T_RES_ACK; //enable send
  }
}

#define ARDUINO_MAIN
#include "wiring_private.h"
#include "pins_arduino_include.h"

uint8_t analogRead(uint8_t pin)
{
    pin = analogPinToChannel(pin);   
    if (pin == NOT_ANALOG) return 0;
    ADC_CFG = bADC_EN | bADC_CLK;   
    ADC_CTRL = (ADC_CTRL & ~(0x03)) | (0x03&pin);   
    ADC_START = 1;   
    while(ADC_START);   
    return ADC_DATA;
}

void analogWrite(uint8_t pin, __xdata uint16_t val)
{
    pinMode(pin, OUTPUT);
    if (val == 0)
    {
        digitalWrite(pin, LOW);
    }
    else if (val >= 256)
    {
        digitalWrite(pin, HIGH);
    }
    else
    {
        switch(digitalPinToPWM(pin))
        {
            case PIN_PWM1:
                PIN_FUNC &= ~(bPWM1_PIN_X);
                PWM_CTRL |= bPWM1_OUT_EN;
                PWM_DATA1 = val;
                break;
            case PIN_PWM2:
                PIN_FUNC &= ~(bPWM2_PIN_X);
                PWM_CTRL |= bPWM2_OUT_EN;
                PWM_DATA2 = val;
                break;
            case PIN_PWM1_:
                PIN_FUNC |= (bPWM1_PIN_X);
                PWM_CTRL |= bPWM1_OUT_EN;
                PWM_DATA1 = val;
                break;
            case PIN_PWM2_:
                PIN_FUNC |= (bPWM2_PIN_X);
                PWM_CTRL |= bPWM2_OUT_EN;
                PWM_DATA2 = val;
                break;
            case NOT_ON_PWM:
            default:
                if (val < 128) {
                    digitalWrite(pin, LOW);
                } else {
                    digitalWrite(pin, HIGH);
                }
        }
    }
}