Betago / Mbed 2 deprecated testmotoe

1

Dependencies:   PID mbed

move.cpp@0:c52fc2fdd2e0, 2016-06-27 (annotated)

Committer:
palmdotax
Date:
Mon Jun 27 21:14:19 2016 +0000
Revision:
0:c52fc2fdd2e0
1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
palmdotax 0:c52fc2fdd2e0 1 #include "mbed.h"
palmdotax 0:c52fc2fdd2e0 2 #include "move.h"
palmdotax 0:c52fc2fdd2e0 3 #include "mbed.h"
palmdotax 0:c52fc2fdd2e0 4 DigitalOut dir1(PA_10);//PA_10
palmdotax 0:c52fc2fdd2e0 5 DigitalOut dir2(PB_3);//PB_3
palmdotax 0:c52fc2fdd2e0 6 PwmOut speeds(PB_4);
palmdotax 0:c52fc2fdd2e0 7 DigitalOut dirr1(PA_9);//PA_8
palmdotax 0:c52fc2fdd2e0 8 DigitalOut dirr2(PC_7);//PB_5
palmdotax 0:c52fc2fdd2e0 9 PwmOut speeds2(PB_10);
palmdotax 0:c52fc2fdd2e0 10 DigitalOut relays(PA_8);
palmdotax 0:c52fc2fdd2e0 11
palmdotax 0:c52fc2fdd2e0 12
palmdotax 0:c52fc2fdd2e0 13
palmdotax 0:c52fc2fdd2e0 14 void move:: movespeed_1(float setpoint,float spd)
palmdotax 0:c52fc2fdd2e0 15 {
palmdotax 0:c52fc2fdd2e0 16 float dc=0;
palmdotax 0:c52fc2fdd2e0 17 if(setpoint>=0)
palmdotax 0:c52fc2fdd2e0 18 {
palmdotax 0:c52fc2fdd2e0 19 dir1=1;
palmdotax 0:c52fc2fdd2e0 20 dir2=0;
palmdotax 0:c52fc2fdd2e0 21 // printf("if1\n");
palmdotax 0:c52fc2fdd2e0 22 }
palmdotax 0:c52fc2fdd2e0 23 else
palmdotax 0:c52fc2fdd2e0 24 {
palmdotax 0:c52fc2fdd2e0 25 dir1=0;
palmdotax 0:c52fc2fdd2e0 26 dir2=1;
palmdotax 0:c52fc2fdd2e0 27 // printf("else1\n");
palmdotax 0:c52fc2fdd2e0 28 }
palmdotax 0:c52fc2fdd2e0 29 dc=setpoint+spd;
palmdotax 0:c52fc2fdd2e0 30 // printf("%f\n",dc);
palmdotax 0:c52fc2fdd2e0 31 speeds2.write(dc);
palmdotax 0:c52fc2fdd2e0 32
palmdotax 0:c52fc2fdd2e0 33
palmdotax 0:c52fc2fdd2e0 34 }
palmdotax 0:c52fc2fdd2e0 35 void move:: movespeed_2(float setpoint,float spd)
palmdotax 0:c52fc2fdd2e0 36 {
palmdotax 0:c52fc2fdd2e0 37 double dc=0;
palmdotax 0:c52fc2fdd2e0 38 if(setpoint>=0)
palmdotax 0:c52fc2fdd2e0 39 {
palmdotax 0:c52fc2fdd2e0 40 dirr1=1;
palmdotax 0:c52fc2fdd2e0 41 dirr2=0;
palmdotax 0:c52fc2fdd2e0 42 // printf("if2\n");
palmdotax 0:c52fc2fdd2e0 43 }
palmdotax 0:c52fc2fdd2e0 44 else
palmdotax 0:c52fc2fdd2e0 45 {
palmdotax 0:c52fc2fdd2e0 46 dirr1=0;
palmdotax 0:c52fc2fdd2e0 47 dirr2=1;
palmdotax 0:c52fc2fdd2e0 48 // printf("else2\n");
palmdotax 0:c52fc2fdd2e0 49 }
palmdotax 0:c52fc2fdd2e0 50 dc=setpoint+spd;
palmdotax 0:c52fc2fdd2e0 51 // printf("%f\n",dc);
palmdotax 0:c52fc2fdd2e0 52 speeds.write(dc);
palmdotax 0:c52fc2fdd2e0 53
palmdotax 0:c52fc2fdd2e0 54
palmdotax 0:c52fc2fdd2e0 55 }
palmdotax 0:c52fc2fdd2e0 56 void move::pump(int on_off)
palmdotax 0:c52fc2fdd2e0 57 {
palmdotax 0:c52fc2fdd2e0 58 relays=on_off;
palmdotax 0:c52fc2fdd2e0 59 }