/* ** =================================================================== ** Method : SCI1_Init (component Init_SCI) ** ** Description : ** This method initializes registers of the SCI module ** according to this Peripheral Initialization Bean settings. ** Call this method in the user code to initialize the ** module. By default, the method is called by PE ** automatically; see "Call Init method" property of the ** bean for more details. ** Parameters : None ** Returns : Nothing ** =================================================================== */ void SCI1_Init(void) { getReg(SCI_STAT); /* Clear interrupt request flags */ /* SCI_RATE: SBR=26,FRAC_SBR=0 */ setReg16(SCI_RATE,208U); /* Set prescaler bits */ /* SCI_CTRL1: LOOP=0,SWAI=0,RSRC=0,M=0,WAKE=0,POL=0,PE=0,PT=0,TEIE=0,TIIE=0,RFIE=1,REIE=0,TE=1,RE=1,RWU=0,SBK=0 */ setReg16(SCI_CTRL1,44U); /* Set the SCI control register */ /* SCI_CTRL2: TFCNT=0,TFWM=0,RFCNT=0,RFWM=0,FIFO_EN=0,??=0,LIN_MODE=0,??=0,??=0,??=0 */ setReg16(SCI_CTRL2,0U); /* Set the SCI control register */ }
/* ** =================================================================== ** Method : DA1_Init (component DAC) ** ** Description : ** Initializes the associated peripheral(s) and the beans ** internal variables. The method is called automatically as a ** part of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void DA1_Init(void) { /* DAC_CTRL: FILT_CNT=0,FILT_EN=0,??=0,??=0,??=0,??=0,??=0,??=0,UP=0,DOWN=0,AUTO=0,SYNC_EN=0,FORMAT=0,PDN=1 */ setReg16(DAC_CTRL, 0x01U); /* DAC_DATA: DATA=0x0800 */ setReg16(DAC_DATA, 0x0800U); /* DAC_MAXVAL: MAXVAL=0 */ setReg16(DAC_MAXVAL, 0x00U); /* DAC_MINVAL: MINVAL=0 */ setReg16(DAC_MINVAL, 0x00U); /* DAC_STEP: STEP=0 */ setReg16(DAC_STEP, 0x00U); /* DAC_CTRL: PDN=0 */ clrReg16Bits(DAC_CTRL, 0x01U); }
/* ** =================================================================== ** Method : FC321_Init (bean FreeCntr32) ** ** Description : ** Initializes the associated peripheral(s) and the beans ** internal variables. The method is called automatically as a ** part of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void FC321_Init(void) { TTicks = 0; /* Counter of timer ticks */ TOvf = FALSE; /* Counter overflow flag */ /* TC7: BIT15=0,BIT14=0,BIT13=0,BIT12=0,BIT11=0,BIT10=0,BIT9=0,BIT8=0,BIT7=0,BIT6=1,BIT5=0,BIT4=0,BIT3=1,BIT2=1,BIT1=1,BIT0=1 */ setReg16(TC7, 79); /* Store given value to the compare register */ }
/* ** =================================================================== ** Method : Servo2_Init (bean PWM) ** ** Description : ** Initializes the associated peripheral(s) and the bean's ** internal variables. The method is called automatically as a ** part of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void Servo2_Init(void) { /* PWMCNT23: BIT15=0,BIT14=0,BIT13=0,BIT12=0,BIT11=0,BIT10=0,BIT9=0,BIT8=0,BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=0 */ setReg16(PWMCNT23, 0); /* Reset Counter */ /* PWMSDN: PWMIF=1,PWMIE=0,PWMRSTRT=0,PWMLVL=0,??=0,PWM7IN=0,PWM7INL=0,PWM7ENA=0 */ setReg8(PWMSDN, 128); /* Emergency shutdown feature settings */ RatioStore = 4964; /* Store initial value of the ratio */ /* PWMDTY23: BIT15=0,BIT14=0,BIT13=0,BIT12=0,BIT11=0,BIT10=1,BIT9=0,BIT8=1,BIT7=1,BIT6=1,BIT5=1,BIT4=0,BIT3=1,BIT2=0,BIT1=1,BIT0=1 */ setReg16(PWMDTY23, 1515); /* Store initial value to the duty-compare register */ /* PWMPER23: BIT15=0,BIT14=1,BIT13=0,BIT12=0,BIT11=1,BIT10=1,BIT9=1,BIT8=0,BIT7=0,BIT6=0,BIT5=1,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=0 */ setReg16(PWMPER23, 20000); /* and to the period register */ /* PWMPRCLK: ??=0,PCKB2=0,PCKB1=0,PCKB0=0,??=0,PCKA2=0,PCKA1=0,PCKA0=0 */ setReg8(PWMPRCLK, 0); /* Set prescaler register */ /* PWMSCLB: BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=1 */ setReg8(PWMSCLB, 1); /* Set scale register */ /* PWMCLK: PCLK3=0 */ clrReg8Bits(PWMCLK, 8); /* Select clock source */ /* PWME: PWME3=1 */ setReg8Bits(PWME, 8); /* Run counter */ }
void _sleepEntryPoint(void) { /*** ### 56F807 "Cpu" init code ... ***/ /* System clock initialization */ setReg(PLLCR, (PLLCR_LCKON_MASK | PLLCR_ZSRC0_MASK)); /* Enable PLL, LCKON and select clock source from prescaler */ /* CLKOSR: ??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,CLKOSEL=0 */ setReg16(CLKOSR, 0); /* CLKO = ZCLOCK */ /* PLLDB: LORTP=0,PLLCOD=0,PLLCID=1,??=0,PLLDB=39 */ setReg16(PLLDB, 295); /* Set the clock prescalers */ while(!getRegBit(PLLSR, LCK0)){} /* Wait for PLL lock */ setReg(PLLCR, (PLLCR_LCKON_MASK | PLLCR_ZSRC1_MASK)); /* Select clock source from postscaler */ /* External bus initialization */ /* BCR: ??=0,??=0,??=0,??=0,??=0,??=0,DRV=1,??=0,WSX=12,WSP=12 */ setReg16(BCR, 716); /* Bus control register */ asm(move #1,y1) /* stores y1=1 for jumping * to mySleep after initialization */ asm(jmp init_56800_); /* Jump to C startup code */ }
void _EntryPoint(void) { /* ### MC9S08PA16_32 "Cpu" init code ... */ /* PE initialization code after reset */ /* WDOG_CNT: CNT=0xC520 */ setReg16(WDOG_CNT, 0xC520U); /* First part of the WDG unlock sequence */ /* WDOG_CNT: CNT=0xD928 */ setReg16(WDOG_CNT, 0xD928U); /* Second part of the WDG unlock sequence */ /* Initialization of Init_WDOG */ /* WDOG_CS1: EN=1,INT=0,UPDATE=1,TST=0,DBG=0,WAIT=1,STOP=1 */ setReg8(WDOG_CS1, 0xA3U); /* WDOG_CS2: WIN=0,FLG=0,??=0,PRES=1,??=0,??=0,CLK=0 */ setReg8(WDOG_CS2, 0x10U); /* WDOG_TOVAL: TOVAL=0xF800 */ setReg16(WDOG_TOVAL, 0xF800U); /* Common initialization of the write once registers */ /* SYS_SOPT1: SCI0PS=0,BKGDPE=1,RSTPE=1,FWAKE=0,STOPE=0 */ clrSetReg8Bits(SYS_SOPT1, 0x83U, 0x0CU); /* PMC_SPMSC1: LVWIE=0,LVDRE=1,LVDSE=1,LVDE=1,BGBDS=0,BGBE=0 */ clrSetReg8Bits(PMC_SPMSC1, 0x23U, 0x1CU); /* PMC_SPMSC2: LVDV=0,LVWV=0 */ clrReg8Bits(PMC_SPMSC2, 0x70U); /* System clock initialization */ /*lint -save -e923 Disable MISRA rule (11.3) checking. */ if (*(uint8_t*)0xFF6FU != 0xFFU) { /* Test if the device trim value is stored on the specified address */ ICS_C3 = *(uint8_t*)0xFF6FU; /* Initialize ICS_C3 register from a non volatile memory */ ICS_C4 = (uint8_t)((*(uint8_t*)0xFF6EU) & (uint8_t)0x01U); /* Initialize ICS_C4 register from a non volatile memory */ } /*lint -restore Enable MISRA rule (11.3) checking. */ /* ICS_C1: CLKS=0,RDIV=0,IREFS=1,IRCLKEN=1,IREFSTEN=0 */ setReg8(ICS_C1, 0x06U); /* Initialization of the ICS control register 1 */ /* ICS_C2: BDIV=1,LP=0,??=0,??=0,??=0,??=0 */ setReg8(ICS_C2, 0x20U); /* Initialization of the ICS control register 2 */ /* ICS_C4: LOLIE=0,CME=0 */ clrReg8Bits(ICS_C4, 0xA0U); /*** End of PE initialization code after reset ***/ /*lint -save -e950 Disable MISRA rule (1.1) checking. */ __asm jmp _Startup ; /* Jump to C startup code */ /*lint -restore Enable MISRA rule (1.1) checking. */ }
/* ** =================================================================== ** Method : M_1_Init (component PWM) ** ** Description : ** Initializes the associated peripheral(s) and the components ** internal variables. The method is called automatically as a ** part of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void M_1_Init(void) { /* TPM1SC: TOF=0,TOIE=0,CPWMS=0,CLKSB=0,CLKSA=0,PS2=0,PS1=0,PS0=0 */ setReg8(TPM1SC, 0x00U); /* Disable device */ /* TPM1C1SC: CH1F=0,CH1IE=0,MS1B=1,MS1A=1,ELS1B=1,ELS1A=1,??=0,??=0 */ setReg8(TPM1C1SC, 0x3CU); /* Set up PWM mode with output signal level low */ ActualRatio.Value = 0xFFFFU; /* Store initial value of the ratio */ /* TPM1MOD: BIT15=1,BIT14=1,BIT13=1,BIT12=1,BIT11=0,BIT10=1,BIT9=0,BIT8=1,BIT7=1,BIT6=1,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=1,BIT0=0 */ setReg16(TPM1MOD, 0xF5C2U); /* Set modulo register */ SetRatio(); /* Calculate and set up new values of the compare according to the selected speed CPU mode */ (void)getReg8(TPM1SC); /* Dummy read of the TPM1SC register to reset flag */ /* TPM1SC: TOF=0,TOIE=1 */ clrSetReg8Bits(TPM1SC, 0x80U, 0x40U); /* Clear Overflow interrupt flag and enable Overflow interrupt */ }
/* ** =================================================================== ** Method : MotorD1_Init (component PWM) ** ** Description : ** Initializes the associated peripheral(s) and the components ** internal variables. The method is called automatically as a ** part of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void MotorD1_Init(void) { /* TPM3SC: TOF=0,TOIE=0,CPWMS=0,CLKSB=0,CLKSA=0,PS2=0,PS1=0,PS0=0 */ setReg8(TPM3SC, 0x00U); /* Disable device */ /* TPM3C0SC: CH0F=0,CH0IE=0,MS0B=1,MS0A=1,ELS0B=1,ELS0A=0,??=0,??=0 */ setReg8(TPM3C0SC, 0x38U); /* Set up PWM mode with output signal level high */ ActualRatio = 0x00U; /* Store initial value of the ratio */ EnUser = FALSE; /* Disable device */ /* TPM3MOD: BIT15=0,BIT14=1,BIT13=1,BIT12=0,BIT11=0,BIT10=0,BIT9=1,BIT8=0,BIT7=0,BIT6=1,BIT5=0,BIT4=0,BIT3=1,BIT2=1,BIT1=0,BIT0=1 */ setReg16(TPM3MOD, 0x624DU); /* Set modulo register */ /* TPM3C0SC: CH0F=0,CH0IE=0,MS0B=1,MS0A=0,ELS0B=0,ELS0A=0,??=0,??=0 */ setReg8(TPM3C0SC, 0x20U); /* Temporary set compare mode to enable modifications of compare register */ SetRatio(); /* Calculate and set up new values of the compare according to the selected speed CPU mode */ HWEnDi(); /* Enable/disable device according to status flags */ }
/* ** =================================================================== ** Method : PWMC1_Init (component PWMMC) ** ** Description : ** Initializes the associated peripheral(s) and the bean internal ** variables. The method is called automatically as a part of the ** application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void PWMC1_Init(void) { /* PWM_PMCTL: LDFQ=0,HALF=0,IPOL2=0,IPOL1=0,IPOL0=0,PRSC=0,PWMRIE=0,PWMF=0,??=0,??=0,LDOK=0,PWMEN=0 */ setReg16(PWM_PMCTL, 0U); /* Set up PWM control register */ /* PWM_PMFCTL: ??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,FIE3=0,FMODE3=1,FIE2=0,FMODE2=1,FIE1=0,FMODE1=1,FIE0=0,FMODE0=1 */ setReg16(PWM_PMFCTL, 85U); /* Set up Fault Control Register */ /* PWM_PMICCR: ??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,ICC2=0,ICC1=0,ICC0=0 */ setReg16(PWM_PMICCR, 0U); /* Set up Internal Correction Control Register */ /* PWM_PMDISMAP1: DISMAP=0 */ setReg16(PWM_PMDISMAP1, 0U); /* PWM_PMDISMAP2: ??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,DISMAP=0 */ setReg16(PWM_PMDISMAP2, 0U); /* PWM_PMOUT: PAD_EN=1,??=0,OUTCTL=0,??=0,??=0,OUT=0 */ setReg16(PWM_PMOUT, 32768U); /* PWM_PMCCR: ENHA=0,nBX=0,MSK=0,??=0,??=0,VLMODE=0,??=0,SWP45=0,SWP23=0,SWP01=0 */ setReg16(PWM_PMCCR, 0U); /* PWM_PMSRC: ??=0,??=0,CINV5=0,CINV4=0,CINV3=0,CINV2=0,CINV1=0,CINV0=0,SRC2=0,SRC1=0,SRC0=0 */ setReg16(PWM_PMSRC, 0U); /* PWM_PMDEADTM0: ??=0,??=0,??=0,??=0,PWMDT0=0 */ setReg16(PWM_PMDEADTM0, 0U); /* PWM_PMDEADTM1: ??=0,??=0,??=0,??=0,PWMDT1=0 */ setReg16(PWM_PMDEADTM1, 0U); /* PWM_PWMVAL0: VAL=800 */ setReg16(PWM_PWMVAL0, 800U); /* PWM_PWMVAL1: VAL=800 */ setReg16(PWM_PWMVAL1, 800U); /* PWM_PWMVAL2: VAL=800 */ setReg16(PWM_PWMVAL2, 800U); /* PWM_PWMVAL3: VAL=800 */ setReg16(PWM_PWMVAL3, 800U); /* PWM_PWMCM: ??=0,CM=1600 */ setReg16(PWM_PWMCM, 1600U); /* PWM_PMCFG: ??=0,DBG_EN=0,WAIT_EN=0,EDG=0,??=0,TOPNEG45=0,TOPNEG23=0,TOPNEG01=0,??=0,BOTNEG45=0,BOTNEG23=0,BOTNEG01=0,INDEP45=0,INDEP23=1,INDEP01=1,WP=0 */ setReg16(PWM_PMCFG, 6U); /* Set up PWM configure register */ /* PWM_PMCTL: LDOK=1 */ setReg16Bits(PWM_PMCTL, 2U); /* Load counter and modulo registers into buffers */ /* PWM_PMCTL: PWMEN=1 */ setReg16Bits(PWM_PMCTL, 1U); /* Run counter */ /* PWM_PMCTL: PWMF=1 */ setReg16Bits(PWM_PMCTL, 16U); /* Clear reload flag made by PWMEN bit */ }
/* ** =================================================================== ** Method : PE_low_level_init (component MC9S08PA16_32) ** ** Description : ** Initializes components and provides common register ** initialization. The method is called automatically as a part ** of the application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void PE_low_level_init(void) { #ifdef PEX_RTOS_INIT PEX_RTOS_INIT(); /* Initialization of the selected RTOS. Macro is defined by the RTOS component. */ #endif /* SCG_C1: FTM2=1,??=0,FTM0=1,??=0,??=0,??=0,MTIM0=1,RTC=1 */ setReg8(SCG_C1, 0xA3U); /* SCG_C2: ??=0,??=0,DBG=1,NVM=1,IPC=1,CRC=1,??=0,??=0 */ setReg8(SCG_C2, 0x3CU); /* SCG_C3: ??=0,??=0,SCI1=1,SCI0=1,??=0,SPI0=1,IIC=1,??=0 */ setReg8(SCG_C3, 0x36U); /* SCG_C4: ACMP=1,??=0,ADC=1,??=0,IRQ=1,??=0,??=0,KBI0=1 */ setReg8(SCG_C4, 0xA9U); /* Common initialization of the CPU registers */ /* SYS_SOPT2: TXDME=0 */ clrReg8Bits(SYS_SOPT2, 0x80U); /* PORT_PTBOE: PTBOE1=1,PTBOE0=0 */ clrSetReg8Bits(PORT_PTBOE, 0x01U, 0x02U); /* PORT_PTBIE: PTBIE1=0,PTBIE0=1 */ clrSetReg8Bits(PORT_PTBIE, 0x02U, 0x01U); /* PORT_PTBD: PTBD1=1 */ setReg8Bits(PORT_PTBD, 0x02U); /* PORT_PTCOE: PTCOE7=1,PTCOE6=0 */ clrSetReg8Bits(PORT_PTCOE, 0x40U, 0x80U); /* PORT_PTCIE: PTCIE7=0,PTCIE6=1 */ clrSetReg8Bits(PORT_PTCIE, 0x80U, 0x40U); /* PORT_PTCD: PTCD7=1 */ setReg8Bits(PORT_PTCD, 0x80U); /* PORT_PTAD: PTAD0=0 */ clrReg8Bits(PORT_PTAD, 0x01U); /* PORT_PTAPE: PTAPE0=0 */ clrReg8Bits(PORT_PTAPE, 0x01U); /* PORT_PTAOE: PTAOE0=1 */ setReg8Bits(PORT_PTAOE, 0x01U); /* PORT_PTAIE: PTAIE0=0 */ clrReg8Bits(PORT_PTAIE, 0x01U); /* PORT_PTDD: PTDD0=0 */ clrReg8Bits(PORT_PTDD, 0x01U); /* PORT_PTDPE: PTDPE0=0 */ clrReg8Bits(PORT_PTDPE, 0x01U); /* PORT_PTDOE: PTDOE0=1 */ setReg8Bits(PORT_PTDOE, 0x01U); /* PORT_PTDIE: PTDIE0=0 */ clrReg8Bits(PORT_PTDIE, 0x01U); /* SYS_SOPT3: CLKOE=0,BUSREF=0 */ clrReg8Bits(SYS_SOPT3, 0x0FU); /* IPC_ILRS9: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS9, 0x00U); /* IPC_ILRS8: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS8, 0x00U); /* IPC_ILRS7: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=2 */ setReg8(IPC_ILRS7, 0x02U); /* IPC_ILRS6: ILRn3=2,ILRn2=2,ILRn1=2,ILRn0=2 */ setReg8(IPC_ILRS6, 0xAAU); /* IPC_ILRS5: ILRn3=2,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS5, 0x80U); /* IPC_ILRS4: ILRn3=2,ILRn2=0,ILRn1=2,ILRn0=2 */ setReg8(IPC_ILRS4, 0x8AU); /* IPC_ILRS3: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS3, 0x00U); /* IPC_ILRS2: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS2, 0x00U); /* IPC_ILRS1: ILRn3=2,ILRn2=2,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS1, 0xA0U); /* IPC_ILRS0: ILRn3=0,ILRn2=0,ILRn1=0,ILRn0=0 */ setReg8(IPC_ILRS0, 0x00U); /* IPC_SC: IPCE=1,??=0,PSE=0,PSF=0,PULIPM=0,??=0,IPM=0 */ setReg8(IPC_SC, 0x80U); /* Initialization of the PORT module */ /* ### Shared modules init code ... */ /* ### Asynchro serial "AS_CCTALK" init code ... */ AS_CCTALK_Init(); /* ### Free running 8-bit counter "FC_CCTALK" init code ... */ FC_CCTALK_Init(); /* ### TimerInt "TI_CCTALK" init code ... */ TI_CCTALK_Init(); /* ### WatchDog "WDOG" init code ... */ WDOG_Init(); /* WDOG_CNT: CNT=0xA602 */ setReg16(WDOG_CNT, 0xA602U); /* WDOG_CNT: CNT=0xB480 */ setReg16(WDOG_CNT, 0xB480U); /* ### Asynchro serial "AS_DATABUS" init code ... */ AS_DATABUS_Init(); /* ### BitIO "LED_RUN" init code ... */ /* ### BitIO "LED_CCTALK" init code ... */ /* ### Free running 8-bit counter "FC_DATABUS" init code ... */ FC_DATABUS_Init(); /* ### TimerInt "TI_LEDS" init code ... */ TI_LEDS_Init(); /* ### IntEEPROM "EEPROM" init code ... */ EEPROM_Init(); /* ### Free running 8-bit counter "FC_HOPPER" init code ... */ FC_HOPPER_Init(); /* Common peripheral initialization - ENABLE */ /* FTM0_SC: CLKS=1 */ clrSetReg8Bits(FTM0_SC, 0x10U, 0x08U); /* FTM2_SC: CLKS=1 */ clrSetReg8Bits(FTM2_SC, 0x10U, 0x08U); CCR_lock = (byte)0; __EI(); /* Enable interrupts */ }
/* ** =================================================================== ** Method : PE_low_level_init (bean MC9S12DG128_112) ** ** Description : ** Initializes beans and provides common register initialization. ** The method is called automatically as a part of the ** application initialization code. ** This method is internal. It is used by Processor Expert only. ** =================================================================== */ void PE_low_level_init(void) { /* Common initialization of the CPU registers */ /* PIEP: PIEP5=0 */ clrReg8Bits(PIEP, 32); /* PTP: PTP5=0,PTP4=0,PTP3=0,PTP1=0 */ clrReg8Bits(PTP, 58); /* PERP: PERP5=0 */ clrReg8Bits(PERP, 32); /* DDRP: DDRP5=1,DDRP4=1,DDRP3=1,DDRP1=1 */ setReg8Bits(DDRP, 58); /* PEAR: NOACCE=0,PIPOE=0,NECLK=1,LSTRE=0,RDWE=0 */ clrSetReg8Bits(PEAR, 172, 16); /* PUCR: PUPKE=0,PUPEE=0,PUPBE=0,PUPAE=0 */ clrReg8Bits(PUCR, 147); /* DDRE: BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0 */ clrReg8Bits(DDRE, 252); /* PTM: PTM4=0,PTM3=0 */ clrReg8Bits(PTM, 24); /* WOMM: WOMM4=0,WOMM3=0 */ clrReg8Bits(WOMM, 24); /* DDRM: DDRM4=1,DDRM3=1 */ setReg8Bits(DDRM, 24); /* PERM: PERM4=0 */ clrReg8Bits(PERM, 16); /* PORTK: BIT3=0,BIT0=0 */ clrReg8Bits(PORTK, 9); /* DDRK: BIT3=1,BIT0=1 */ setReg8Bits(DDRK, 9); /* PTS: PTS1=1 */ setReg8Bits(PTS, 2); /* DDRS: DDRS1=1,DDRS0=0 */ clrSetReg8Bits(DDRS, 1, 2); /* PWME: PWME7=0,PWME6=0,PWME5=0,PWME4=0,PWME3=0,PWME2=0,PWME1=0,PWME0=0 */ setReg8(PWME, 0); /* PWMCTL: CON45=0,CON23=1,CON01=1,PSWAI=0,PFRZ=0 */ clrSetReg8Bits(PWMCTL, 76, 48); /* PWMCAE: CAE4=0,CAE3=0,CAE1=0 */ clrReg8Bits(PWMCAE, 26); /* PWMPOL: PPOL4=0,PPOL3=0,PPOL1=0 */ clrReg8Bits(PWMPOL, 26); /* PBCTL: PBEN=0 */ clrReg8Bits(PBCTL, 64); /* TSCR1: TEN=0,TSWAI=0,TSFRZ=0,TFFCA=0 */ clrReg8Bits(TSCR1, 240); /* DLYCT: ??=0,??=0,??=0,??=0,??=0,??=0,DLY1=0,DLY0=0 */ setReg8(DLYCT, 0); /* ICSYS: SH37=0,SH26=0,SH15=0,SH04=0,TFMOD=0,PACMX=0,BUFEN=0,LATQ=0 */ setReg8(ICSYS, 0); /* ICOVW: NOVW7=0,NOVW5=0,NOVW0=0 */ clrReg8Bits(ICOVW, 161); /* TCTL4: EDG0B=1,EDG0A=1 */ setReg8Bits(TCTL4, 3); /* TCTL3: EDG7B=0,EDG7A=0,EDG5B=0,EDG5A=0 */ clrReg8Bits(TCTL3, 204); /* TIOS: IOS7=0,IOS5=0,IOS0=0 */ clrReg8Bits(TIOS, 161); /* PERT: PERT7=0,PERT5=0,PERT0=0 */ clrReg8Bits(PERT, 161); /* PORTA: BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=0 */ setReg8(PORTA, 0); /* DDRA: BIT7=1,BIT6=1,BIT5=1,BIT4=1,BIT3=1,BIT2=1,BIT1=1,BIT0=1 */ setReg8(DDRA, 255); /* PORTB: BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=0 */ setReg8(PORTB, 0); /* DDRB: BIT7=1,BIT6=1,BIT5=1,BIT4=1,BIT3=1,BIT2=1,BIT1=1,BIT0=1 */ setReg8(DDRB, 255); /* TIE: C7I=0,C5I=0 */ clrReg8Bits(TIE, 160); /* PACTL: CLK1=0,CLK0=0 */ clrReg8Bits(PACTL, 12); /* ATD0DIEN: IEN0=0 */ clrReg8Bits(ATD0DIEN, 1); /* ATD1DIEN: IEN0=0 */ clrReg8Bits(ATD1DIEN, 1); /* CRGINT: LOCKIE=0,SCMIE=0 */ clrReg8Bits(CRGINT, 18); /* COPCTL: RSBCK=0 */ clrReg8Bits(COPCTL, 64); /* RDRIV: RDPK=0,RDPE=0,RDPB=0,RDPA=0 */ clrReg8Bits(RDRIV, 147); /* RDRH: RDRH7=0,RDRH6=0,RDRH5=0,RDRH4=0,RDRH3=0,RDRH2=0,RDRH1=0,RDRH0=0 */ setReg8(RDRH, 0); /* RDRJ: RDRJ7=0,RDRJ6=0,RDRJ1=0,RDRJ0=0 */ clrReg8Bits(RDRJ, 195); /* RDRM: RDRM7=0,RDRM6=0,RDRM5=0,RDRM4=0,RDRM3=0,RDRM2=0,RDRM1=0,RDRM0=0 */ setReg8(RDRM, 0); /* RDRP: RDRP7=0,RDRP6=0,RDRP5=0,RDRP4=0,RDRP3=0,RDRP2=0,RDRP1=0,RDRP0=0 */ setReg8(RDRP, 0); /* RDRS: RDRS7=0,RDRS6=0,RDRS5=0,RDRS4=0,RDRS3=0,RDRS2=0,RDRS1=0,RDRS0=0 */ setReg8(RDRS, 0); /* RDRT: RDRT7=0,RDRT6=0,RDRT5=0,RDRT4=0,RDRT3=0,RDRT2=0,RDRT1=0,RDRT0=0 */ setReg8(RDRT, 0); /* INTCR: IRQEN=0 */ clrReg8Bits(INTCR, 64); /* PACN10: BIT15=0,BIT14=0,BIT13=0,BIT12=0,BIT11=0,BIT10=0,BIT9=0,BIT8=0,BIT7=0,BIT6=0,BIT5=0,BIT4=0,BIT3=0,BIT2=0,BIT1=0,BIT0=0 */ setReg16(PACN10, 0); /* ### MC9S12DG128_112 "Cpu112" init code ... */ /* ### BitIO "ForwardOrBackward" init code ... */ /* ### ByteIO "E" init code ... */ /* ### BitIO "MotorEnableM3" init code ... */ /* ### BitIO "M4" init code ... */ Shadow_M &= (byte)~16; /* Initialize pin shadow variable bit */ /* ### BitIO "K0" init code ... */ Shadow_K &= (byte)~1; /* Initialize pin shadow variable bit */ /* ### BitIO "MotorEnableK3" init code ... */ /* ### Asynchro serial "SCI" init code ... */ SCI_Init(); /* ### Programable pulse generation "Servo1" init code ... */ Servo1_Init(); /* ### Programable pulse generation "Servo2" init code ... */ Servo2_Init(); /* ### Programable pulse generation "MainMotor" init code ... */ MainMotor_Init(); /* ### PulseAccumulator "SpeedSensor" init code ... */ SpeedSensor_Init(); /* ### ByteIO "PORTA" init code ... */ /* ### ByteIO "PORTB" init code ... */ /* ### Timer capture encapsulation "Cap1" init code ... */ Cap1_Init(); /* ### Timer capture encapsulation "Cap2" init code ... */ Cap2_Init(); /* ### "ATC0" init code ... */ ATC0_Init(); /* ### "ATC1" init code ... */ ATC1_Init(); /* Common peripheral initialization - ENABLE */ /* TSCR1: TEN=1 */ setReg8Bits(TSCR1, 128); __EI(); /* Enable interrupts */ }