Питание электродвигателя на 100 в от сети 220 вольт

/******************************************************
STM8S003K3 16MHz, IAR1.4+STM8S_StdPeriph_Lib_V2.1.0
******************************************************/
#include <stm8s.h>
#include <iostm003.c>

#define _bitset(bits) ((\
  (bits%010)|\
  (bits/010%010)<<1|\
  (bits/0100%010)<<2|\
  (bits/01000%010)<<3|\
  (bits/010000%010)<<4|\
  (bits/0100000%010)<<5|\
  (bits/01000000%010)<<6|\
  (bits/010000000%010)<<7))
#define binary(bits) _bitset(0##bits) //  u8 a = binary(01100011);

#define LEDA    PD_ODR_ODR3


enum dmodes {normal,started** d_mode=started;

volatile u8 tim0,tim1;
const u8 nts=5;
u16 adc2val=0, adc3val=(u16)(110UL*0x03ff/UHV_max_adc);

static void gpio_cfg()
**
  	PA_DDR=PB_DDR=PC_DDR=PD_DDR=PE_DDR=PF_DDR=0xff; //conf as output
   	PA_CR1=PB_CR1=PC_CR1=PD_CR1=PE_CR1=PF_CR1=0xff; //push-pull|pullup
  //PA_CR2=PB_CR2=PC_CR2=PD_CR2=PE_CR2=PF_CR2=0;    //speed 2MHz|int disabled

	PE_DDR_DDR5=0; //PS det input, pullup
   	PD_DDR_DDR0=0; PD_CR1_C10=0; //BKIN, pullup off
**
static void clk_cfg()
**
  	CLK_DeInit();
	CLK->CKDIVR = 0;
	CLK->PCKENR1 = 0x80; //only tim1&adc clk enabled
**
static void iwdg_cfg()
**
  IWDG_WriteAccessCmd(IWDG_WriteAccess_Enable);
  IWDG_SetPrescaler(IWDG_Prescaler_128);
  IWDG_SetReload((uint8_t)(128000/(128*250)));
  IWDG_ReloadCounter();
  /* Enable IWDG (the LSI oscillator will be enabled by hardware) */
  IWDG_Enable();
  IWDG_WriteAccessCmd(IWDG_WriteAccess_Disable);
  IWDG_ReloadCounter();

**
static void t1_cfg()
**
  **
  TIM1->ARRH = 0;
  TIM1->ARRL = 0xff;

	TIM1->CR1 = TIM1_COUNTERMODE_CENTERALIGNED1|TIM1_CR1_ARPE|TIM1_CR1_URS;
	TIM1->CR2 = TIM1_CR2_CCPC;
	TIM1->RCR = 1;
  TIM1->IER = TIM1_IER_UIE;
  **

  TIM1->CCER1=TIM1->CCER2=TIM1->CCMR1=TIM1->CCMR2=0;

  TIM1->CCER1|= TIM1_CCER1_CC1E|TIM1_CCER1_CC1NE|TIM1_CCER1_CC1NP;
  TIM1->CCER1|= TIM1_CCER1_CC2E|TIM1_CCER1_CC2NE|TIM1_CCER1_CC2NP;
  TIM1->CCMR1|= TIM1_OCMODE_PWM1;
  TIM1->CCMR2|= 0x40;  //force OC2ref inactive level;
  TIM1->EGR  |= TIM1_EGR_COMG;     //update CCER reg with COM event

	TIM1->OISR = binary(0001010); //iddle state - all fets off
	TIM1->BKR  = TIM1_BKR_BKE|TIM1_BKR_BKP|TIM1_BKR_OSSR|TIM1_BKR_OSSI;
	TIM1->DTR  = 0x30; //3us dt delay (62ns*48)
	TIM1->CR1 |= TIM1_CR1_CEN;
 	TIM1->BKR |= TIM1_LOCKLEVEL_2;

**
static void adc_cfg()
**

	ADC1->CR1 = ADC1_PRESSEL_FCPU_D18;
	ADC1->CR2 = ADC1_ALIGN_RIGHT;
 	ADC1->CSR = 2; //channel sel
	ADC1->TDRL = binary(00001100); //smtt trg on adc pins is off
	ADC1->CR1 |= ADC1_CR1_ADON;
**


void delay(volatile u16 nCount)
**
    while (nCount)
    **
        nCount--;
        IWDG_ReloadCounter();
    **
**

void lblk(u8 tlight, u8 tdark, u8 *j)
**
 static u8 stage;

 if(*j>9)***j=11;**
 if(*j)
 **
 if((!tim0)&&(!stage)){tim0=tlight; LEDA=1; stage=1;**
 else if ((!tim0)&&(stage)){tim0=tdark; stage=LEDA=0; --*j;**
 **
 else {stage=LEDA=0;**
**
void ADC_read()
**
#define crlv 32

  static u8 counter2=crlv,counter3=crlv;
  static u16 tmp2=0,tmp3=0;
	union {u8 t[2]; u16 f;**adc;

  if(ADC1->CSR&ADC1_FLAG_EOC)
  **
	adc.t[1] = ADC1->DRL;
	adc.t[0] = ADC1->DRH;

    if((ADC1->CSR&0x0f)==2)
   **
	 if(counter2){counter2--;tmp2+=adc.f;**
     else {counter2=crlv;adc2val=tmp2/(crlv+1);tmp2=adc.f;**
     ADC1->CSR = 3;
   **
   else
   **
     if(counter3){counter3--;tmp3+=adc.f;**
     else {counter3=crlv;adc3val=tmp3/(crlv+1);tmp3=adc.f;**
     ADC1->CSR = 2;
   **

   ADC1_StartConversion();
  **
**
void dev_mgmt();

INTERRUPT_HANDLER(TIM1_UPD_OVF_TRG_BRK_IRQHandler, 11)
**
#define s_step 262
#define n_table 10
static u8 i=0;
static u8 rck=0, dir;


static const u8 s_table [n_table][s_step/2]=
**
{0,2,4,7,9,12,14,16,19,21,24,26,28,31,33,36,38,40,43,45,47,
50,52,54,57,59,61,64,66,68,71,73,75,77,79,82,84,86,88,90,93,95,
97,99,101,103,105,107,109,111,113,115,117,119,121,123,125,127,129,131,132,134,136,
138,139,141,143,145,146,148,150,151,153,154,156,157,159,160,162,163,164,166,167,169,
170,171,172,174,175,176,177,178,179,180,181,182,183,184,185,186,187,188,189,190,190,
191,192,193,193,194,194,195,196,196,197,197,197,198,198,199,199,199,199,200,200,200,
200,200,200,200,200**
,
{0,2,4,6,9,11,13,16,18,20,22,25,27,29,32,34,36,38,41,43,45,
47,49,52,54,56,58,60,63,65,67,69,71,73,76,78,80,82,84,86,88,90,
92,94,96,98,100,102,104,106,108,110,111,113,115,117,119,121,122,124,126,127,129,
131,133,134,136,137,139,141,142,144,145,147,148,149,151,152,154,155,156,158,159,160,
161,163,164,165,166,167,168,169,170,171,172,173,174,175,176,177,178,179,179,180,181,
182,182,183,184,184,185,185,186,186,187,187,188,188,188,189,189,189,190,190,190,190,
190,190,190,190,190**
,
{0,2,4,6,8,10,13,15,17,19,21,23,26,28,30,32,34,36,38,41,43,
45,47,49,51,53,55,57,59,61,63,65,68,70,72,74,75,77,79,81,83,85,
87,89,91,93,95,97,98,100,102,104,106,107,109,111,112,114,116,118,119,121,122,
124,126,127,129,130,132,133,135,136,137,139,140,142,143,144,146,147,148,149,151,152,
153,154,155,156,157,158,159,160,161,162,163,164,165,166,167,168,168,169,170,171,171,
172,173,173,174,174,175,176,176,176,177,177,178,178,178,179,179,179,180,180,180,180,
180,180,180,180,180**
,
{0,2,4,6,8,10,12,14,16,18,20,22,24,26,28,30,32,34,36,38,40,
42,44,46,48,50,52,54,56,58,60,62,64,66,68,69,71,73,75,77,79,81,
82,84,86,88,89,91,93,95,96,98,100,101,103,105,106,108,109,111,113,114,116,
117,119,120,122,123,124,126,127,128,130,131,132,134,135,136,137,139,140,141,142,143,
144,145,147,148,149,150,151,152,152,153,154,155,156,157,158,158,159,160,161,161,162,
163,163,164,164,165,165,166,166,167,167,168,168,168,169,169,169,169,170,170,170,170,
170,170,170,170,170**
,
{0,1,3,5,7,9,11,13,15,17,19,21,23,25,27,28,30,32,34,36,38,
40,42,44,45,47,49,51,53,55,56,58,60,62,64,65,67,69,71,72,74,76,
77,79,81,83,84,86,87,89,91,92,94,95,97,98,100,101,103,104,106,107,109,
110,112,113,114,116,117,118,120,121,122,123,125,126,127,128,129,131,132,133,134,135,
136,137,138,139,140,141,142,143,144,144,145,146,147,148,148,149,150,150,151,152,152,
153,154,154,155,155,156,156,157,157,157,158,158,158,159,159,159,159,160,160,160,160,
160,160,160,160,160**
,
{0,1,3,5,7,9,10,12,14,16,18,19,21,23,25,27,28,30,32,34,36,
37,39,41,43,44,46,48,49,51,53,55,56,58,60,61,63,65,66,68,69,71,
73,74,76,77,79,80,82,83,85,86,88,89,91,92,94,95,97,98,99,101,102,
103,105,106,107,108,110,111,112,113,115,116,117,118,119,120,121,122,123,124,125,126,
127,128,129,130,131,132,133,134,135,135,136,137,138,138,139,140,140,141,142,142,143,
143,144,144,145,145,146,146,147,147,148,148,148,149,149,149,149,150,150,150,150,150,
150,150,150,150,150**
,
{0,1,3,5,6,8,10,11,13,15,16,18,20,21,23,25,26,28,30,31,33,
35,36,38,40,41,43,45,46,48,49,51,52,54,56,57,59,60,62,63,65,66,
68,69,71,72,74,75,77,78,79,81,82,83,85,86,88,89,90,91,93,94,95,
96,98,99,100,101,102,104,105,106,107,108,109,110,111,112,113,114,115,116,117,118,
119,120,121,122,122,123,124,125,126,126,127,128,129,129,130,130,131,132,132,133,133,
134,134,135,135,136,136,137,137,137,138,138,138,139,139,139,139,140,140,140,140,140,
140,140,140,140,140**
,
{0,1,3,4,6,7,9,11,12,14,15,17,18,20,21,23,25,26,28,29,31,
32,34,35,37,38,40,41,43,44,46,47,49,50,52,53,55,56,57,59,60,62,
63,64,66,67,68,70,71,72,74,75,76,78,79,80,81,82,84,85,86,87,88,
90,91,92,93,94,95,96,97,98,99,100,101,102,103,104,105,106,107,108,109,110,
111,111,112,113,114,114,115,116,117,117,118,119,119,120,121,121,122,122,123,123,124,
124,125,125,126,126,127,127,127,128,128,128,129,129,129,129,129,130,130,130,130,130,
130,130,130,130,130**
,
{0,1,2,4,5,7,8,10,11,13,14,15,17,18,20,21,23,24,26,27,28,
30,31,33,34,35,37,38,40,41,42,44,45,46,48,49,50,52,53,54,56,57,
58,59,61,62,63,64,66,67,68,69,70,72,73,74,75,76,77,78,79,81,82,
83,84,85,86,87,88,89,90,91,92,93,94,94,95,96,97,98,99,100,100,101,
102,103,104,104,105,106,106,107,108,108,109,110,110,111,111,112,112,113,113,114,114,
115,115,116,116,116,117,117,118,118,118,118,119,119,119,119,120,120,120,120,120,120,
120,120,120,120,120**
,
{0,1,2,4,5,6,8,9,10,12,13,14,15,17,18,19,21,22,23,25,26,
27,29,30,31,32,34,35,36,37,39,40,41,42,44,45,46,47,49,50,51,52,
53,54,56,57,58,59,60,61,62,63,65,66,67,68,69,70,71,72,73,74,75,
76,77,78,79,80,81,81,82,83,84,85,86,87,87,88,89,90,91,91,92,93,
94,94,95,96,96,97,98,98,99,99,100,101,101,102,102,103,103,104,104,104,105,
105,106,106,106,107,107,107,108,108,108,109,109,109,109,109,110,110,110,110,110,110,
110,110,110,110,110**
**;

 if(!i)
 **
 dir=1;i=1;
   if(rck)
   **
    rck=0;
  TIM1->CCMR1 = TIM1_OCMODE_PWM1;
	TIM1->CCMR2 = 0x40; //force OC2ref inactive level
    if(tim0)tim0--;
   **
   else
   **
    rck=1;
	TIM1->CCMR1 = 0x40; //force OC1ref inactive level
	TIM1->CCMR2 = TIM1_OCMODE_PWM1;
    if(tim1)tim1--;
   **

   TIM1->EGR|=TIM1_EGR_COMG; //update CCMR

 **
 else if((dir)&&(i<s_step/2-1))
 **
   TIM1->CCR1H=TIM1->CCR2H=0;
   TIM1->CCR1L=TIM1->CCR2L=s_table[nts][i];
   i++;
 **
 else
 **
   dir=0; i--;
   TIM1->CCR1H=TIM1->CCR2H=0;
   TIM1->CCR1L=TIM1->CCR2L=s_table[nts][i];
 **

 	IWDG_ReloadCounter();
	TIM1->SR1 = 0;	//clear int state reg
**

void main()
**

gpio_cfg();
clk_cfg();
//adc_cfg();
t1_cfg();
iwdg_cfg();

BEEP_Init(BEEP_FREQUENCY_2KHZ);
BEEP_Cmd(DISABLE);

//ADC1_StartConversion ();

asm("rim");


  while(1)
  **
	
	dev_mgmt();

  **

**

void assert_failed(uint8_t* file, uint32_t line)
**

**

void dev_mgmt()
**

 switch (d_mode)
 **

  case normal:
  **
	static u8 trg=0, con=0, con2=0;

	if(TIM1->BKR &TIM1_BKR_MOE){LEDA=1;**
	else {LEDA=0;**

	if(PD_IDR_IDR0)
	**
	  if(con<2) con++;
		else {con=0;tim1=0xff; TIM1->BKR&=~TIM1_BKR_MOE;**		
	**
	else {con=0;**


	if((!PE_IDR_IDR5)&&(!PD_IDR_IDR0))
	**
		if((!tim1)&&(!(TIM1->BKR&TIM1_BKR_MOE))){TIM1->BKR |=TIM1_BKR_MOE;**
	**
	else 
	**
		if(con2<100) con2++;
		else {con2=0; TIM1->BKR&=~TIM1_BKR_MOE; tim1=0xff;**
	**

	if((tim1)&&(!trg))
	**
	trg=1;
		for(u8 i=3;i;i--)
		**
		BEEP_Cmd(ENABLE);
		delay(65000);
		BEEP_Cmd(DISABLE);
		if(i>1){delay(65000);**
		**
	**
	else if (!tim1){trg=0;**


  **
  break;

  case started:
  **

    BEEP_Cmd(ENABLE);
    delay(65000);
    BEEP_Cmd(DISABLE);

	while (PE_IDR_IDR5);
	d_mode=normal;
  TIM1->BKR |=TIM1_BKR_MOE;
  **
  break;

  default: break;
 **

**