mtr_func.cpp

00001 /**
00002 *Funktionen zur Ansteuerung des Steppermotors
00003 *
00004 *CPP-Datei mtr_func.cpp
00005 *
00006 *@version: 01.11.2015
00007 *@author: Gustav Grether
00008 */
00009 
00010 #include "mtr_func.h"
00011 
00012 //Ausgaenge Mikrocontroller
00013 DigitalOut mtr_en(p21); //Digital Ausgang: EN
00014 DigitalOut mtr_dir(p22); //Digital Ausgang: DIR
00015 PwmOut mtr_pwm(p23); //PWM-Ausgang: STEP
00016 
00017 
00018 //Variablen fuer mtr_pwm_set()
00019 int mtr_period=0; //Periodendauer der PWM
00020 
00021 void mtr_en_set(int state)
00022 {
00023     //Einschaltzustand setzen.
00024     //1 = Motor wird mit Strom versorgt.
00025     //0 = Motor ist stromlos
00026     mtr_en = state;
00027 }
00028 
00029 void mtr_dir_set(int dir)
00030 {
00031     // Drehrichtung setzen
00032     //1 = in +y fahren
00033     //0 = in -y fahren
00034     mtr_dir = dir;
00035 }
00036 
00037 int mtr_period_get(){
00038     return mtr_period;
00039 }
00040 void mtr_period_set(int period)
00041 {
00042     mtr_period=period;
00043     mtr_pwm.period_us(mtr_period);
00044     mtr_pwm.write(0.5);//PWM-Tastverhaeltnis setzen
00045 }