// PWM Driver - LPC176x - Single edge only, does not support double edge PWM
//
// Copyright 2017 Brett Fleming
//
// Permission is hereby granted, free of charge, to any person obtaining a copy
// of this software and associated documentation files (the "Software"), to deal
// in the Software without restriction, including without limitation the rights
// to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
// copies of the Software, and to permit persons to whom the Software is
// furnished to do so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in
// all copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
// FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
// IN THE SOFTWARE.

#include "pwm_driver.h"
#include "LPC17xx.h"

//#include "grbl.h"

//LPC_PWM1_BASE
//LPC_PWM1 is of type LPC_PWM_TypeDef at Address LPC_PWM1_BASE

/*
    Theory of operation: Initialize, start running, change width any time while running.

    pwm_init(PWM1_CH1, 1000, 0);
    pwm_enable(PWM1_CH1);
    pwm_set_width(250);
    sleep(1)
    pwm_set_width(500);
    sleep(1)
    pwm_set_width(999);
    sleep(1)
    pwm_disable(PWM1_CH1);
*/


const PWM_Channel_Config PWM1_CH1 = {
    &(LPC_PWM1->MR1),   //Match Register
    (1 << 9),           //PWM Enable
    (1 << 1),           //Latch Enable Register
    (0x2 << 4),         //PINSEL3 - P1.18
    (0x1 << 0)          //PINSEL4 - P2.0
};

const PWM_Channel_Config PWM1_CH2 = {
    &(LPC_PWM1->MR2),   //Match Register
    (1 << 10),          //PWM Enable
    (1 << 2),           //Latch Enable Register
    (0x2 << 8),         //PINSEL3 - P1.20
    (0x1 << 2)          //PINSEL4 - P2.1
};

const PWM_Channel_Config PWM1_CH3 = {
    &(LPC_PWM1->MR3),   //Match Register
    (1 << 11),          //PWM Enable
    (1 << 3),           //Latch Enable Register
    (0x2 << 10),        //PINSEL3 - P1.21
    (0x1 << 4)          //PINSEL4 - P2.2
};

const PWM_Channel_Config PWM1_CH4 = {
    &(LPC_PWM1->MR4),   //Match Register
    (1 << 12),          //PWM Enable
    (1 << 4),           //Latch Enable Register
    (0x2 << 14),        //PINSEL3 - P1.23
    (0x1 << 6)          //PINSEL4 - P2.3
};

const PWM_Channel_Config PWM1_CH5 = {
    &(LPC_PWM1->MR5),   //Match Register
    (1 << 13),          //PWM Enable
    (1 << 5),           //Latch Enable Register
    (0x2 << 16),        //PINSEL3 - P1.24
    (0x1 << 8)          //PINSEL4 - P2.4
};

const PWM_Channel_Config PWM1_CH6 = {
    &(LPC_PWM1->MR6),   //Match Register
    (1 << 14),          //PWM Enable
    (1 << 6),           //Latch Enable Register
    (0x2 << 20),        //PINSEL3 - P1.26
    (0x1 << 10)         //PINSEL4 - P2.6
};


//UM10360 LPC17xx Chapter 24 - Pulse Width Modulation

//
// channel - Which of the 6 PWM channels to init.
// period - what is the overall period, in PCLK cycles, for ALL PWMs (not just the provided one)
//
void pwm_init(PWM_Channel_Config* channel, bool primaryPin, bool secondaryPin, uint32_t period, uint32_t width) {

    //Power up PWM Circuitry - Defaulted to on at reset, but doesn't hurt to make sure
    LPC_SC->PCONP |= 1 << 6; // Power up the PWM

    //Pin mode selections
    if (primaryPin) LPC_PINCON->PINSEL3 |= channel->PINSEL3_Enable_Mask;
    if (secondaryPin) LPC_PINCON->PINSEL4 |= channel->PINSEL4_Enable_Mask;

    //PWM Control Register - Disable output for channel
    LPC_PWM1->PCR &= ~channel->PCR_Enable_Mask;

    //Match Control - Continous operation (no interrupts, reset counter on MSR0 match (period))
    LPC_PWM1->MCR = (1 << 1); 

    //PWM Control Register - Single Edge (0 for bits 2-6) mode for all PWMs
    LPC_PWM1->PCR &= 0xFF00;
    
    //Disable Capture
    LPC_PWM1->CCR = 0x0000;

    //PWM Timer Control Register - Counter Enable, PWM Enable
    LPC_PWM1->TCR = (1 << 0) | (1 << 2);

    pwm_set_period(period);
    pwm_set_width(channel, width);
}

void pwm_set_period(uint32_t period) {
    LPC_PWM1->MR0 = period;

    //If we are running, this will make the MRx register on the next cycle
    LPC_PWM1->LER = 0x00000001;
}

void pwm_set_width(PWM_Channel_Config* channel, uint32_t width) {
    *(channel->MRn) = width;

    //If we are running, this will make the MRx register on the next cycle
    LPC_PWM1->LER = channel->LER_Enable_Mask;
}

void pwm_enable(PWM_Channel_Config* channel) {
    //PWM Control Register - Enable output for channel
    LPC_PWM1->PCR |= channel->PCR_Enable_Mask;
}

void pwm_disable(PWM_Channel_Config* channel) {
    //PWM Control Register - Disable output for channel
    LPC_PWM1->PCR &= ~channel->PCR_Enable_Mask;
}