Dmitry Kovalev / Mbed 2 deprecated LGstaandart

forkd

Dependencies:   mbed

Fork of LG2 by Dmitry Kovalev

MCPWM.c@227:2774b56bfab0, 2018-01-05 (annotated)

Committer:
Kovalev_D
Date:
Fri Jan 05 08:14:38 2018 +0000
Revision:
227:2774b56bfab0
Parent:
214:4c70e452c491 
05.01.2018

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Kovalev_D 214:4c70e452c491 1 #include "stdlib.h"
Kovalev_D 214:4c70e452c491 2 //#include "math.h"
Kovalev_D 214:4c70e452c491 3 #include "LPC17xx.h"
Kovalev_D 214:4c70e452c491 4 #include "Global.h"
Kovalev_D 214:4c70e452c491 5 unsigned int fhz=350,T_vib=5,T_vib_1=10000,T_vib_2=100000,AmpP=3000,err;
Kovalev_D 214:4c70e452c491 6 float T_vibP=10000, F_vib=258000;
Kovalev_D 214:4c70e452c491 7
Kovalev_D 214:4c70e452c491 8
Kovalev_D 214:4c70e452c491 9 void InitMCPWM(void)
Kovalev_D 214:4c70e452c491 10 {
Kovalev_D 214:4c70e452c491 11 // Power up MCPWM
Kovalev_D 214:4c70e452c491 12
Kovalev_D 214:4c70e452c491 13 LPC_SC->PCONP |= 1<<17;
Kovalev_D 214:4c70e452c491 14 LPC_SC->PCLKSEL1 |= 1<<30;
Kovalev_D 214:4c70e452c491 15
Kovalev_D 214:4c70e452c491 16
Kovalev_D 214:4c70e452c491 17 // Configuring P1.25 and P1.28 as MC1A and MC2A
Kovalev_D 214:4c70e452c491 18 LPC_PINCON->PINSEL3 |= (1<<18) | (1<<24);
Kovalev_D 214:4c70e452c491 19 LPC_MCPWM->CON_SET |= 0x40070707;
Kovalev_D 214:4c70e452c491 20 LPC_MCPWM->CAPCON_SET |= 0x1c0000;
Kovalev_D 214:4c70e452c491 21
Kovalev_D 214:4c70e452c491 22 // Start MCPWM channels 1 and 2 and POLA = 1
Kovalev_D 214:4c70e452c491 23 LPC_MCPWM->CON_CLR = 0xffffffff;
Kovalev_D 214:4c70e452c491 24 LPC_MCPWM->CON_SET = (0<<10) | (1<<18) | (1<<16) | (1<<8) | (1<<9) | (1<<17);
Kovalev_D 214:4c70e452c491 25 }
Kovalev_D 214:4c70e452c491 26
Kovalev_D 214:4c70e452c491 27 void ReVib(void)
Kovalev_D 227:2774b56bfab0 28 {
Kovalev_D 227:2774b56bfab0 29
Kovalev_D 227:2774b56bfab0 30 Gyro.AmpPer = ((Gyro.Amp*100)>>17);
Kovalev_D 214:4c70e452c491 31
Kovalev_D 214:4c70e452c491 32 F_vib=(103200000<<5)/((Gyro.Frq)>>10);//периуд вибро.
Kovalev_D 214:4c70e452c491 33 T_vibP = F_vib/10000;
Kovalev_D 214:4c70e452c491 34
Kovalev_D 214:4c70e452c491 35 LPC_MCPWM->LIM1 = F_vib;
Kovalev_D 214:4c70e452c491 36 LPC_MCPWM->LIM2 = F_vib;
Kovalev_D 214:4c70e452c491 37 }