kind of working
This commit is contained in:
parent
43e1c5c384
commit
9cd6d87704
@ -14,9 +14,9 @@
|
|||||||
|
|
||||||
|
|
||||||
void adcInit() {
|
void adcInit() {
|
||||||
ADC10CTL0 = ADC10SHT_1 | ADC10ON | SREF_0;
|
ADC10CTL0 = ADC10SHT_0 | ADC10ON | SREF_0;
|
||||||
ADC10CTL1 = INCH_5;
|
ADC10CTL1 = INCH_7 | ADC10SSEL_3;
|
||||||
ADC10AE0 = BIT5;
|
ADC10AE0 = BIT7;
|
||||||
}
|
}
|
||||||
|
|
||||||
uint16_t adcGet() {
|
uint16_t adcGet() {
|
||||||
|
@ -25,6 +25,8 @@ void init() {
|
|||||||
BCSCTL1 = XT2OFF | RSEL0 | RSEL1 | RSEL2 | RSEL3;
|
BCSCTL1 = XT2OFF | RSEL0 | RSEL1 | RSEL2 | RSEL3;
|
||||||
BCSCTL2 = 0;
|
BCSCTL2 = 0;
|
||||||
BCSCTL3 = 0;
|
BCSCTL3 = 0;
|
||||||
|
|
||||||
|
P1DIR |= BIT0 | BIT1 | BIT2 | BIT3;
|
||||||
}
|
}
|
||||||
|
|
||||||
int main() {
|
int main() {
|
||||||
|
26
src/pwm.cpp
26
src/pwm.cpp
@ -17,7 +17,7 @@
|
|||||||
|
|
||||||
volatile Control ctrl((float)PWM_MIN, (float)PWM_MAX, Ctrl_P, Ctrl_I, Ctrl_D);
|
volatile Control ctrl((float)PWM_MIN, (float)PWM_MAX, Ctrl_P, Ctrl_I, Ctrl_D);
|
||||||
|
|
||||||
volatile float u_des = 0;
|
volatile float u_des = 12.0;
|
||||||
volatile float u_curr = 0;
|
volatile float u_curr = 0;
|
||||||
volatile uint16_t newPwm = 0;
|
volatile uint16_t newPwm = 0;
|
||||||
|
|
||||||
@ -29,15 +29,12 @@ void pwmInit() {
|
|||||||
P1OUT = 0;
|
P1OUT = 0;
|
||||||
|
|
||||||
TACCR0 = PWM_MAX;
|
TACCR0 = PWM_MAX;
|
||||||
TACCR1 = 8;
|
TACCR1 = 128;
|
||||||
TACCTL0 = CCIE;
|
TACCTL0 = CCIE;
|
||||||
TACCTL1 = OUTMOD_7;
|
TACCTL1 = OUTMOD_7;
|
||||||
TACTL = MC_1 | ID_0 | TASSEL_2 | TACLR;
|
TACTL = MC_1 | ID_0 | TASSEL_2 | TACLR;
|
||||||
}
|
}
|
||||||
|
|
||||||
void pwmSet(uint16_t v) {
|
|
||||||
TACCR1 = v;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
ISR(TIMER0_A0, TA0_ISR) {
|
ISR(TIMER0_A0, TA0_ISR) {
|
||||||
@ -49,13 +46,30 @@ ISR(TIMER0_A0, TA0_ISR) {
|
|||||||
|
|
||||||
|
|
||||||
uint16_t adcIn = adcGet();
|
uint16_t adcIn = adcGet();
|
||||||
|
|
||||||
|
|
||||||
float u_adc = ((float)adcIn) * U_ref / ((float)ADC_MAX);
|
float u_adc = ((float)adcIn) * U_ref / ((float)ADC_MAX);
|
||||||
u_curr = u_adc * (R_top + R_bottom) / R_bottom;
|
u_curr = u_adc * (R_top + R_bottom) / R_bottom;
|
||||||
|
|
||||||
float newPwm_f = ctrl.cycle(u_des, u_curr);
|
float newPwm_f = ctrl.cycle(u_des, u_curr);
|
||||||
newPwm = (uint16_t) newPwm_f;
|
newPwm = (uint16_t) newPwm_f;
|
||||||
|
|
||||||
pwmSet(newPwm);
|
// P1OUT |= BIT1;
|
||||||
|
// for (uint8_t i = 0; i < 16; i++) {
|
||||||
|
// P1OUT |= BIT3;
|
||||||
|
// uint16_t x = newPwm >> i;
|
||||||
|
// if ((x & 1) == 1) {
|
||||||
|
// P1OUT |= BIT2;
|
||||||
|
// } else {
|
||||||
|
// P1OUT &= ~BIT2;
|
||||||
|
// }
|
||||||
|
// P1OUT &= ~BIT3;
|
||||||
|
// }
|
||||||
|
// P1OUT &= ~BIT1;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
TACCR1 = newPwm;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user