БЭМЗ полищук доки / mogilev yst / МК7007БМ / SW_ON_I

/*дг­ЄжЁп Ї« ў­®Ј® ўЄ«о祭Ёп в®Є  ЊЉ7007Ѓ 2009Ј.*/
         /*Ї®¤Є«о祭ЁҐ § Ј®«®ўЄ®ў ў­гв७­Ёе ॣЁбва®ў 80‘31*/
#include <io51.h>

         /*®ЇаҐ¤Ґ«Ґ­ЁҐ  ¤аҐб®ў гбва®©бвў ўў®¤ -ўлў®¤ */
#define inta_wrrg2 (*(char*) 0x015800) /*бЎа®б § Їа®б  Є« ўЁ вгал -Ї® з⥭Ёо*/
                                      /*§ ЇЁбм ў ॣЁбва  ¬Ї«Ёвг¤ -Ї® § ЇЁбЁ*/

extern  void delayi(char);
extern  void loadcw(void);

extern float curr_new;
float curr_new_a;
extern float curr_old;
extern float l_curr_old;
extern float const_cor_a;
float pszi;
int pszi_int;
char b;
extern float m_cor_flt[81];
extern char number_step;



void sw_on_i(float curr_new,float curr_old,float l_curr_old,char number_step)
{
    if(l_curr_old==60.0)const_cor_a=m_cor_flt[7];
    if(l_curr_old==12.0)const_cor_a=m_cor_flt[6];
    if(l_curr_old==6.0)const_cor_a=m_cor_flt[5];
    if(l_curr_old==0.6)const_cor_a=m_cor_flt[4];
    if(l_curr_old==0.06)const_cor_a=m_cor_flt[3];
    if(l_curr_old==0.006)const_cor_a=m_cor_flt[2];

      curr_new_a=curr_new*const_cor_a;

for (b=1;b<=number_step;b=b+1)
{
pszi=((curr_old+((curr_new_a-curr_old)/number_step)*b)/l_curr_old)*15600.0;
		pszi_int=(unsigned int)pszi; 
		cw0=(char)pszi_int;
		pszi_int=pszi_int>>8;
		cw1=(char)pszi_int;
            inta_wrrg2=0x08;
		loadcw();
            inta_wrrg2=0;

		delayi(10);
}
}