tim004 tim004
Ediba Žubor Sumejja Porča
Revision 0:03eb4b0feb7e, committed 2014-05-12
- Comitter:
- tim004
- Date:
- Mon May 12 18:02:37 2014 +0000
- Commit message:
- LV09 Zad02;
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon May 12 18:02:37 2014 +0000
@@ -0,0 +1,71 @@
+#include "mbed.h"
+#include "sMotor.h"
+
+
+Serial pc(USBTX, USBRX);
+sMotor motor(dp9, dp10, dp11, dp13); // creates new stepper motor: IN1, IN2, IN3, IN4
+
+int step_speed = 1200 ; // set default motor speed
+int numstep = 512 ; // defines full turn of 360 degree
+int direction = 0; //0 for right, 1 for left
+
+ void screenMenu()
+ {
+ // Screen Menu
+ pc.printf("Default Speed: %d, press: \n\r",step_speed);
+ pc.printf("1- to choose random angle to set new motor state\n\r");
+ pc.printf("2- to change the motor direction\n\r");
+ pc.printf("3- to change the rotation speed\n\r");
+ pc.printf("4- to start/stop the motor\n\r");
+}
+int main() {
+
+ screenMenu();
+
+ while (1) {
+
+ if (pc.readable()) { // checks for serial
+ char c (pc.getc());
+ if (c == '1')
+ {
+
+ int angle;
+ pc.printf("\nSpecify the angle to move the motor from current position: \n\r");
+ pc.scanf("%d", &angle);
+ if ( angle > 0 )
+ motor.step(numstep / 360 * (angle % 360), direction, step_speed); // number of steps, direction, speed
+ else
+ motor.step(numstep / 360 * (angle % 360), 1 - direction, step_speed); // number of steps, direction, speed
+
+ screenMenu();
+ }
+
+ if (c =='2')
+ {
+ direction = 1 - direction;
+ pc.printf("\nDirection is changed.\n");
+ screenMenu();
+ }
+ if ( c =='3')
+ {
+ pc.printf("\nCurrent Speed: %d\n\r", step_speed);
+ pc.printf("\nNew speed: \n\r");
+ pc.scanf("%d",&step_speed); // sets new speed
+ pc.printf("\nThe speed has been changed.");
+ screenMenu();
+ }
+
+ if (c =='4')
+ {
+ pc.printf("\nPress 0 to stop the motor: \n\r");
+ int korak=10;
+ while (!pc.readable() || pc.getc() != '0'){
+ motor.step(korak, direction, step_speed);
+ korak+=10;}
+ wait(2);
+ screenMenu();
+ }
+
+ }
+ }
+}
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Mon May 12 18:02:37 2014 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/8a40adfe8776 \ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/sMotor.lib Mon May 12 18:02:37 2014 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/XtaticO/code/sMotor/#4b3b9e047ce3