You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
83 lines
1.3 KiB
83 lines
1.3 KiB
#include "stm8s.h"
|
|
#include <stdio.h>
|
|
#include "bootstrap.h"
|
|
|
|
#define LEVEL_TOP 400
|
|
#define LEVEL_MAX 370
|
|
|
|
volatile uint16_t level = 200;
|
|
|
|
/**
|
|
* Set PWM level
|
|
*/
|
|
void PWM_Write(void)
|
|
{
|
|
uint16_t tmp = level;
|
|
if (tmp > LEVEL_MAX) tmp = LEVEL_MAX;
|
|
TIM1_SetCompare4(tmp);
|
|
}
|
|
|
|
void PWM_Cmd(FunctionalState fs)
|
|
{
|
|
TIM1_CtrlPWMOutputs(fs);
|
|
}
|
|
|
|
/**
|
|
* Set up the PWM generation
|
|
*/
|
|
void PWM_Setup()
|
|
{
|
|
// open drain, fast
|
|
GPIOC->DDR |= GPIO_PIN_4; // out
|
|
//GPIOC->CR1 &= ~GPIO_PIN_4; // open drain
|
|
GPIOC->CR2 |= GPIO_PIN_4; // fast
|
|
|
|
TIM1_TimeBaseInit(0, TIM1_COUNTERMODE_UP, LEVEL_TOP, 0);
|
|
|
|
TIM1_OC4Init(TIM1_OCMODE_PWM1,
|
|
TIM1_OUTPUTSTATE_ENABLE,
|
|
level,
|
|
TIM1_OCPOLARITY_HIGH,
|
|
TIM1_OCIDLESTATE_SET);
|
|
|
|
TIM1_Cmd(ENABLE);
|
|
}
|
|
|
|
/**
|
|
* Set up the analog input
|
|
*/
|
|
void AIN_Setup()
|
|
{
|
|
ADC1_ConversionConfig(ADC1_CONVERSIONMODE_CONTINUOUS,
|
|
ADC1_CHANNEL_3,
|
|
ADC1_ALIGN_RIGHT);
|
|
ADC1_Cmd(ENABLE);
|
|
ADC1_StartConversion();
|
|
}
|
|
|
|
void main(void)
|
|
{
|
|
uint16_t cnt = 0;
|
|
uint16_t conv;
|
|
|
|
SimpleInit();
|
|
PWM_Setup();
|
|
AIN_Setup();
|
|
|
|
// Go
|
|
PWM_Cmd(ENABLE);
|
|
|
|
while (1) {
|
|
if (cnt++ == 65535) {
|
|
cnt = 0;
|
|
LED_Toggle();
|
|
}
|
|
|
|
// adjust level
|
|
if (ADC1_GetFlagStatus(ADC1_FLAG_EOC)) {
|
|
conv = ADC1_GetConversionValue();
|
|
level = conv;
|
|
PWM_Write();
|
|
}
|
|
}
|
|
}
|
|
|