Daniel Vizcaya / Mbed 2 deprecated 01_Embebidos

Acercamiento a lo que pide el profe

Dependencies:   mbed

Fork of 01-01EjercicioFuncionXY by ferney alberto beltran molina

Tomando como base los ejemplos que el Ing. Ferney subió, realizamos este primer acercamiento al objetivo del primer corte.

en síntesis se generó el código de guardar y ejecutar.

Slds!

stepmotor.cpp

Committer:
Bethory
Date:
2018-04-25
Revision:
6:87a37f4163bd

File content as of revision 6:87a37f4163bd:


/******************************************************************************
        Desarrollado por ferney beltran fbeltran@ecci.edu.co

libreria  ejemplo para el motor paso a paso unipolar de 4 fases

******************************************************************************/

//*****************************************************************************

#include "stepmotor.h"
#include "mbed.h"
 





stepmotor::stepmotor(PinName in1, PinName in2, PinName in3, PinName in4) : motor_out(in1,in2,in3,in4) { 


    motor_out=0x0;
    nstep=0;
    motorSpeed=1100;
    
}
 
 
void stepmotor::move() { 
   
   switch(nstep)
        { 
            case 0: motor_out = 0x1; break;  // 0001
            case 1: motor_out = 0x3; break;  // 0011
            case 2: motor_out = 0x2; break;  // 0010   
            case 3: motor_out = 0x6; break;  // 0110
            case 4: motor_out = 0x4; break;  // 0100
            case 5: motor_out = 0xC; break;  // 1100
            case 6: motor_out = 0x8; break;  // 1000
            case 7: motor_out = 0x9; break;  // 1001
            
            default: motor_out = 0x0; break; // 0000
        }
        wait_us(motorSpeed);
        
}

void stepmotor::set_speed(int speed){
    motorSpeed=speed; //set motor speed us 
}
uint32_t stepmotor::get_speed(){
    return motorSpeed; // 
}

void stepmotor::step(uint32_t num_steps, bool cw) {
// funcion para mover el motor N pasos CW o CCW   
// num_steps  número de paso que da el motor 
// cw =True  para dirección en sentido del reloj 
// cw =False para dirección contraria de las manecillas del reloj         
   
    uint32_t count=num_steps ;
    while(count){
        if (cw)   nstep++;     
        else      nstep--;
        if (nstep>7) nstep=0;
        if (nstep<0) nstep=7;
        move();
        count--;

    }
  
}