Group 9 BioRobotics / Mbed 2 deprecated homing

homing

Dependencies:   mbed

main.cpp

Committer:
s1725696
Date:
2018-11-01
Revision:
2:ff77628098e4
Parent:
1:555373c1b9be

File content as of revision 2:ff77628098e4:

#include "mbed.h"

//positie van start punten in counts
double rotation_end_position=1;
double tower_1_position=1;
double tower_end_position=1;
const int revcounts = 25*8400;
int counts1=1;
int counts2=1;

// 
void translation_start(int a,int b){}
void translation_stop(){}
void rotation_start(int a, int b){}
void rotation_stop(){}

void homing()
{
    //translation home
    if (counts2 > ((tower_end_position - tower_1_position)/2)){
        translation_start(0,1);
        }
    else {    
        translation_start(1,1);
        }
    if (counts2 > ((tower_end_position - tower_1_position)/2 - 100)){
        if (counts2 < ((tower_end_position - tower_1_position)/2 + 100)){
            translation_stop();
            }
        else{}
        }
    else{}
    
    }
    
int main()
{
  homing();
  }