PWM

#include <stdio.h>
#include <limits.h>
#include <math.h>

#include <bcm2835.h>

#define DISABLED 00
#define ENABLED 1

#define PWM_CHANNEL_0 0
#define PWM_CHANNEL_1 1

#define PWM_BALANCED_MODE 0
#define PWM_MARKSPACE_MODE 1


void configurePinForPwmChannel(int channel) {
    int quit = 0;
    int pwmPins[][2] = {
        {12, 18}
        , {13, 19}
    };
    int channelPin;

    while (!quit) {
        printf("\nSaisir le n° de GPIO désiré pour le canal %d du PWM (%d ou %d) : "
            , channel
            , pwmPins[ channel ][ 0 ]
            , pwmPins[ channel ][ 1 ]
            );
        scanf("%d", &channelPin);
        if(channelPin == pwmPins[ channel ][ 0 ]) {
            bcm2835_gpio_fsel(channelPin, BCM2835_GPIO_FSEL_ALT0);
            quit = 1;
        } else if(channelPin == pwmPins[ channel ][ 1 ]) {
            bcm2835_gpio_fsel(channelPin, BCM2835_GPIO_FSEL_ALT5);
            quit = 1;
        } else {
            printf("\n!! N° de GPIO non valide pour le canal 0 du PWM !!\n");
        }
    }
}

void setPwmMode(int channel) {
    int quit = 0;
    int pwmMode;

    while( !quit ) {
        printf("\nSaisir le mode de fonctionnement désiré pour le canal %d du PWM (0=BALANCED, 1=MARK-SPACE) : "
            , channel
            );
        scanf("%d", &pwmMode);
        if((pwmMode == PWM_BALANCED_MODE) || (pwmMode == PWM_MARKSPACE_MODE)) {
            bcm2835_pwm_set_mode(channel, pwmMode, ENABLED);
            quit = 1;
        } else {
            printf("\n!! Mode non valide pour le PWM !!\n");
        }        
    }
}

void setPwmClockDivider() {
    int quit = 0;
    unsigned long pwmClockDivider;

    while( !quit ) {
        printf("\nSaisir la puissance de 2 pour le diviseur de fréquence de l'oscillateur (19.2MHz) commun aux 2 canaux du PWM ([0, 11]) : ");
        scanf("%d", &pwmClockDivider);
        if((pwmClockDivider >= 0) && (pwmClockDivider <= 11)) {
            bcm2835_pwm_set_clock(pow(2, pwmClockDivider));
            quit = 1;
        } else {
            printf("\n!! Valeur non valide pour l'étendue !!\n");
        }        
    }
}

void setPwmRange(int channel) {
    int quit = 0;
    unsigned long pwmRange;

    while( !quit ) {
        printf("\nSaisir l'étendue pour le canal %d du PWM ([0, 2^32-1]) : "
            , channel
            );
        scanf("%d", &pwmRange);
        if((pwmRange >= 0) && (pwmRange <= UINT_MAX)) {
            bcm2835_pwm_set_range(channel, pwmRange);
            quit = 1;
        } else {
            printf("\n!! Valeur non valide pour l'étendue !!\n");
        }        
    }
}

void setPwmData(int channel) {
    int quit = 0;
    unsigned long pwmData;

    while( !quit ) {
        printf("\nSaisir la donnée pour le canal %d du PWM ([0, 2^32-1]) : "
            , channel
            );
        scanf("%d", &pwmData);
        if((pwmData >= 0) && (pwmData <= UINT_MAX)) {
            bcm2835_pwm_set_data(channel, pwmData);
            quit = 1;
        } else {
            printf("\n!! Valeur non valide pour la donnée !!\n");
        }        
    }
}

int main() {
    if( bcm2835_init() != 1) {
        printf("!! Erreur d'initialisation de la librairie bcm2835 !!");
        exit(-1);
    }

    configurePinForPwmChannel(0);
    configurePinForPwmChannel(1);

    setPwmMode(0);
    setPwmMode(1);

    setPwmClockDivider();

    setPwmRange(0);
    setPwmRange(1);

    setPwmData(0);
    setPwmData(1);

    bcm2835_close();
}