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

/*”г­ЄжЁп § ЇЁбЁ б¤ўЁЈ  д §л ў ᨭ⥧ в®ал ЊЉ7006-60Ђ ь30
      Copyright (c) ЃҐ«Ё«м­ЁЄ®ў ‚.„. Ёо­м 2005Ј.           */

         /*Ї®¤Є«о祭ЁҐ § Ј®«®ўЄ®ў ў­гв७­Ёе ॣЁбва®ў 80‘31*/
#include <io51.h>
         /*Ї®¤Є«о祭ЁҐ § Ј®«®ўЄ®ў ЎЁЎ«Ё®вҐз­ле дг­ЄжЁ©*/
#include <stdlib.h>

extern  void loadcwf(void);            /*§ Јаг§Є  гЇа.б«®ў  ў ᨭ⥧ в®а*/
extern  void delayi(char);     /*§ ¤Ґа¦Є  б Єў ­в®¬ 10¬б*/

         /*®ЇаҐ¤Ґ«Ґ­ЁҐ  ¤аҐб®ў гбва®©бвў ўў®¤ -ўлў®¤ */
#define wrreg_rdk2     (*(char*) 0x015000) /*§ ЇЁбм ў ॣЁбва гЇа ў«Ґ­Ёп 
                                            Ё з⥭ЁҐ 2-Ј® Ў ©в  Є« ўЁ вгал*/

/*®ЇЁб ­ЁҐ ЇҐаҐ¬Ґ­­ле*/
extern unsigned int phase_shift;
extern unsigned char adr_sint;

/*--------------------------------------------------------------------------*/
void loadphase(adr_sint)
{
         wrreg_rdk2= wrreg_rdk2|adr_sint;
         cw0=(char)phase_shift;
         cw1=0x18;
         loadcwf();
         wrreg_rdk2=0;
         delayi(1);     

         wrreg_rdk2= wrreg_rdk2|adr_sint;
         cw0=(char)((phase_shift>>8)&0x0f);
         cw1=0x09;
         loadcwf();
         wrreg_rdk2=0;
}