Chciałem napisać sobie bardzo prostą bibliotekę sterującą jednym silnikiem DC za pomocą L293D. Teoretycznie program powinien zakręcić silnikiem w obie strony i go wyłączyć. Niestety silnik nie reagował, więc podłączyłem zamiast niego diodę, żeby zobaczyć czy PWM działa. Po starcie programu dioda raz mruga i bardzo szybko gaśnie. Nic więcej się nie dzieje. Kod wygląda następująco:
L293D.h
[syntax=c]
#ifndef L293D_H
#define L293D_H
#include <avr/io.h>
#define MOTOR_1A_DIR DDRD
#define MOTOR_1A_PORT PORTD
#define MOTOR_1A_PIN (1<<PD6)
#define MOTOR_2A_DIR DDRD
#define MOTOR_2A_PORT PORTD
#define MOTOR_2A_PIN (1<<PD4)
#define OC2_DIR DDRB
#define OC2_PIN (1<<PB3)
void MOTOR_init(void);
void MOTOR_left(void);
void MOTOR_right(void);
void MOTOR_stop(void);
void MOTOR_off(void);
#endif /* L293D_H */
[/syntax]
L293D.c
[syntax=c]
#include "L293D.h"
void MOTOR_init(void){
//Kierunek pinów 1A i 2A - wyjściowy
MOTOR_1A_DIR |= MOTOR_1A_PIN;
MOTOR_2A_DIR |= MOTOR_2A_PIN;
//Stan pinów 1A i 2A - niski
MOTOR_1A_PORT &= ~MOTOR_1A_PIN;
MOTOR_2A_PORT &= ~MOTOR_2A_PIN;
//Kierunek pinu OC2 - wyjściowy
OC2_DIR |= OC2_PIN;
//Tryb Fast PWM
TCCR2 |= (1<<WGM20) | (1<<WGM21);
//Clear OC2 on Compare Match, set OC2 at BOTTOM
TCCR2 |= (1<<COM21);
//Ustawienie preskalera na 1
TCCR2 |= (1<<CS20);
//Wypełnienie PWM
OCR2 = 0;
}
void MOTOR_left(void){
MOTOR_1A_PORT &= ~MOTOR_1A_PIN;
MOTOR_2A_PORT |= MOTOR_2A_PIN;
OCR2 = 255;
}
void MOTOR_right(void){
MOTOR_1A_PORT |= MOTOR_1A_PIN;
MOTOR_2A_PORT &= ~MOTOR_2A_PIN;
OCR2 = 255;
}
void MOTOR_stop(void){
MOTOR_1A_PORT &= ~MOTOR_1A_PIN;
MOTOR_2A_PORT &= ~MOTOR_2A_PIN;
OCR2 = 255;
}
void MOTOR_off(void){
OCR2 = 0;
}
[/syntax]
main.c
[syntax=c]
#include <avr/io.h>
#include <util/delay.h>
#include "L293D.h"
#define F_CPU 8000000
int main(void)
{
MOTOR_init();
_delay_ms(1000);
MOTOR_left();
_delay_ms(2000);
MOTOR_right();
_delay_ms(2000);
MOTOR_stop();
while(1)
{
}
}
[/syntax]
Kod w C wklejamy przy pomocy [syntax=c] - Zielony J. Statystyki: Napisane przez merazmus — 11 lut 2013, o 17:17
]]>
to nie komputer PC tylko elektronika i schemat czy PCB to podstawa.