101 lines
2.6 KiB
C
101 lines
2.6 KiB
C
/*
|
|
* =====================================================================================
|
|
*
|
|
* ________ .__ __ ________ ____ ________
|
|
* \_____ \ __ __|__| ____ | | __\______ \ _______ _/_ |/ _____/
|
|
* / / \ \| | \ |/ ___\| |/ / | | \_/ __ \ \/ /| / __ \
|
|
* / \_/. \ | / \ \___| < | ` \ ___/\ / | \ |__\ \
|
|
* \_____\ \_/____/|__|\___ >__|_ \/_______ /\___ >\_/ |___|\_____ /
|
|
* \__> \/ \/ \/ \/ \/
|
|
*
|
|
* www.optixx.org
|
|
*
|
|
*
|
|
* Version: 1.0
|
|
* Created: 07/21/2009 03:32:16 PM
|
|
* Author: david@optixx.org
|
|
*
|
|
* =====================================================================================
|
|
*/
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <avr/io.h>
|
|
#include <avr/interrupt.h>
|
|
|
|
#include "pwm.h"
|
|
#include "debug.h"
|
|
#include "info.h"
|
|
#include "sram.h"
|
|
|
|
|
|
#define PWM_SINE_MAX 64
|
|
#define PWM_OVERFLOW_MAX 1024
|
|
uint8_t pwm_sine_table[] = {
|
|
0x7f,0x8b,0x97,0xa4,0xaf,0xbb,0xc5,0xcf,0xd9,0xe1,0xe8,0xef,0xf4,0xf8,0xfb,0xfd,
|
|
0xfd,0xfd,0xfb,0xf8,0xf3,0xee,0xe7,0xe0,0xd7,0xce,0xc4,0xb9,0xae,0xa2,0x96,0x89,
|
|
0x7e,0x71,0x65,0x59,0x4d,0x42,0x37,0x2d,0x24,0x1c,0x15,0x0f,0x09,0x05,0x03,0x01,
|
|
0x01,0x01,0x03,0x07,0x0b,0x11,0x17,0x1f,0x28,0x31,0x3b,0x46,0x52,0x5e,0x6a,0x76
|
|
};
|
|
|
|
volatile uint8_t pwm_setting;
|
|
volatile uint16_t pwm_overflow;
|
|
volatile uint8_t pwm_idx;
|
|
volatile uint16_t pwm_overflow_max;
|
|
|
|
ISR(TIMER2_COMPA_vect) {
|
|
static uint8_t pwm_cnt=0;
|
|
OCR2A += (uint16_t)T_PWM;
|
|
|
|
if (pwm_setting> pwm_cnt)
|
|
led_pwm_on();
|
|
else
|
|
led_pwm_off();
|
|
|
|
if (pwm_cnt==(uint8_t)(PWM_STEPS-1))
|
|
pwm_cnt=0;
|
|
else
|
|
pwm_cnt++;
|
|
if (pwm_overflow_max == pwm_overflow++ ){
|
|
pwm_setting = pwm_sine_table[pwm_idx++];
|
|
pwm_overflow = 0;
|
|
if (PWM_SINE_MAX == pwm_idx)
|
|
pwm_idx = 0;
|
|
}
|
|
}
|
|
|
|
void pwm_speed(uint16_t val) {
|
|
pwm_overflow_max = val;
|
|
}
|
|
|
|
void pwm_speed_slow(uint16_t val) {
|
|
pwm_overflow_max = PWM_OVERFLOW_MAX * 2 ;
|
|
}
|
|
|
|
void pwm_speed_fast(uint16_t val) {
|
|
pwm_overflow_max = PWM_OVERFLOW_MAX / 2;
|
|
}
|
|
|
|
void pwm_speed_normal(uint16_t val) {
|
|
pwm_overflow_max = PWM_OVERFLOW_MAX;
|
|
}
|
|
|
|
|
|
void pwm_set(uint8_t val) {
|
|
pwm_setting = val;
|
|
}
|
|
|
|
void pwm_stop(void) {
|
|
while(pwm_setting!=0xfd);
|
|
TIMSK2 = 0;
|
|
}
|
|
|
|
void pwm_init(void) {
|
|
pwm_overflow_max = PWM_OVERFLOW_MAX;
|
|
pwm_setting = 0x7f;
|
|
pwm_overflow = 0;
|
|
//cli();
|
|
TCCR2B = 1;
|
|
TIMSK2 |= (1<<OCIE2A);
|
|
sei();
|
|
}
|