Twisting jig experiment.

Dependencies:   TextLCD

Committer:
yphilippou
Date:
Fri Dec 21 15:38:53 2018 +0000
Revision:
0:273dc75dc8fa
Buttons for experiment steps added.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yphilippou 0:273dc75dc8fa 1 #include "mbed.h"
yphilippou 0:273dc75dc8fa 2 #include "TextLCD.h"
yphilippou 0:273dc75dc8fa 3 #include "SETUP.hpp"
yphilippou 0:273dc75dc8fa 4
yphilippou 0:273dc75dc8fa 5
yphilippou 0:273dc75dc8fa 6 //#include <iostream>
yphilippou 0:273dc75dc8fa 7
yphilippou 0:273dc75dc8fa 8 //using namespace std;
yphilippou 0:273dc75dc8fa 9 //Serial pc(USBTX, USBRX); //define serial namespace so the serial comms can be printed to
yphilippou 0:273dc75dc8fa 10 //TextLCD lcd(D0,D1,D4,D5,D6,D7); // rs, e, d4-d7
yphilippou 0:273dc75dc8fa 11
yphilippou 0:273dc75dc8fa 12 DigitalOut myled(LED1);
yphilippou 0:273dc75dc8fa 13 DigitalIn B1(PE_15);
yphilippou 0:273dc75dc8fa 14 DigitalIn B2(PE_14);
yphilippou 0:273dc75dc8fa 15 DigitalIn B3(PE_12);
yphilippou 0:273dc75dc8fa 16 DigitalIn B4(PE_10);
yphilippou 0:273dc75dc8fa 17
yphilippou 0:273dc75dc8fa 18 int main() {
yphilippou 0:273dc75dc8fa 19
yphilippou 0:273dc75dc8fa 20 //pc.baud(9600);
yphilippou 0:273dc75dc8fa 21
yphilippou 0:273dc75dc8fa 22 printf("Putty test\n"); //request command in the terminal
yphilippou 0:273dc75dc8fa 23
yphilippou 0:273dc75dc8fa 24 //lcd.printf("Hello World!\n");
yphilippou 0:273dc75dc8fa 25
yphilippou 0:273dc75dc8fa 26
yphilippou 0:273dc75dc8fa 27 printf("Please input a number of rotations\n");
yphilippou 0:273dc75dc8fa 28
yphilippou 0:273dc75dc8fa 29 // Spin the motor
yphilippou 0:273dc75dc8fa 30
yphilippou 0:273dc75dc8fa 31 while(1) {
yphilippou 0:273dc75dc8fa 32 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 33 wait(1);
yphilippou 0:273dc75dc8fa 34 if(B1)
yphilippou 0:273dc75dc8fa 35 {
yphilippou 0:273dc75dc8fa 36 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 37 printf("20 Turns\n");
yphilippou 0:273dc75dc8fa 38 STEPPER_MOTOR_1.Rotate_Steps(22);
yphilippou 0:273dc75dc8fa 39 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 40 wait(1); //
yphilippou 0:273dc75dc8fa 41 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 42 wait(1); // 1 sec
yphilippou 0:273dc75dc8fa 43 printf("Turning Complete\n");
yphilippou 0:273dc75dc8fa 44 }
yphilippou 0:273dc75dc8fa 45 else if(B2)
yphilippou 0:273dc75dc8fa 46 {
yphilippou 0:273dc75dc8fa 47 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 48 printf("30 Turns\n");
yphilippou 0:273dc75dc8fa 49 STEPPER_MOTOR_1.Rotate_Steps(23);
yphilippou 0:273dc75dc8fa 50 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 51 wait(1); //
yphilippou 0:273dc75dc8fa 52 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 53 wait(1); // 1 sec
yphilippou 0:273dc75dc8fa 54 printf("Turning Complete\n");
yphilippou 0:273dc75dc8fa 55 }
yphilippou 0:273dc75dc8fa 56 else if(B3)
yphilippou 0:273dc75dc8fa 57 {
yphilippou 0:273dc75dc8fa 58 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 59 printf("40 Turns\n");
yphilippou 0:273dc75dc8fa 60 STEPPER_MOTOR_1.Rotate_Steps(24);
yphilippou 0:273dc75dc8fa 61 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 62 wait(1); //
yphilippou 0:273dc75dc8fa 63 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 64 wait(1); // 1 sec
yphilippou 0:273dc75dc8fa 65 printf("Turning Complete\n");
yphilippou 0:273dc75dc8fa 66 }
yphilippou 0:273dc75dc8fa 67 else if(B4)
yphilippou 0:273dc75dc8fa 68 {
yphilippou 0:273dc75dc8fa 69 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 70 printf("50 Turns\n");
yphilippou 0:273dc75dc8fa 71 STEPPER_MOTOR_1.Rotate_Steps(25);
yphilippou 0:273dc75dc8fa 72 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 73 wait(1); //
yphilippou 0:273dc75dc8fa 74 myled = 0; // LED is OFF
yphilippou 0:273dc75dc8fa 75 wait(1); // 1 sec
yphilippou 0:273dc75dc8fa 76 printf("Turning Complete\n");
yphilippou 0:273dc75dc8fa 77 }
yphilippou 0:273dc75dc8fa 78 else {
yphilippou 0:273dc75dc8fa 79 myled = 1; // LED is ON
yphilippou 0:273dc75dc8fa 80 }
yphilippou 0:273dc75dc8fa 81 }
yphilippou 0:273dc75dc8fa 82
yphilippou 0:273dc75dc8fa 83 }
yphilippou 0:273dc75dc8fa 84