pwm2.h

Go to the documentation of this file.

#ifndef libpropeller_pwm2_h__
#define libpropeller_pwm2_h__


#include <propeller.h>
extern char _load_start_pwm2_cog[];

class PWM2 {
public:

    void Start(void) {
        volatile void * asm_reference = NULL;
        __asm__ volatile ( "mov %[asm_reference], #PWM2_Entry \n\t"
                : [asm_reference] "+r" (asm_reference));

        SetDutyX(0);
        SetDutyY(0);
        SetPinX(-1);
        SetPinY(-1);

        SetFrequency(kDefaultFrequency);
        Cog = cognew(_load_start_pwm2_cog, &Periodxy) + 1;
    }

    void Stop(void) {
        if (Cog > 0) {
            SetDutyX(0);
            SetDutyY(0);
            waitcnt(Periodxy * 2 + CNT);
            cogstop(Cog - 1);
            Cog = 0;
        }

    }

    void SetPinX(const int pinX) {
        pin_x = pinX;
        if (pin_x == -1) {
            Pinxmask = 0;
            Ctrxval = 0;

        } else {
            Pinxmask = (1 << pinX);
            Ctrxval = ((4 << 26) + pinX);
        }
    }

    void SetPinY(const int pinY) {
        pin_y = pinY;
        if (pin_y == -1) {
            Pinymask = 0;
            Ctryval = 0;
        } else {
            Pinymask = (1 << pinY);
            Ctryval = ((4 << 26) + pinY);
        }
    }

    void SetDutyX(const int percent) {
        Percentx = percent;
        Dutyx = ((percent * Periodxy) / 100);
    }

    void SetDutyY(const int percent) {
        Percenty = percent;
        Dutyy = ((percent * Periodxy) / 100);
    }

    void SetFrequency(const int frequency) {
        Periodxy = (CLKFREQ / frequency);
        SetDutyX(Percentx);
        SetDutyY(Percenty);
    }
private:
    int Cog;
    int Percentx, Percenty;
    int pin_x, pin_y;
    int volatile Periodxy;
    int volatile Dutyx, Pinxmask, Ctrxval;
    int volatile Dutyy, Pinymask, Ctryval;

    static const int kDefaultFrequency = 12000;
};

#endif // libpropeller_pwm2_h__