10/25/2015

Dependencies:   PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot

Committer:
palmdotax
Date:
Thu Mar 03 09:07:22 2016 +0000
Revision:
12:8a06a803e373
Parent:
11:9df7ada37d31
LOL

Who changed what in which revision?

UserRevisionLine numberNew contents of line
palmdotax 0:f02641e3fb91 1 #include "mbed.h"
palmdotax 0:f02641e3fb91 2 #include "move.h"
palmdotax 0:f02641e3fb91 3
palmdotax 0:f02641e3fb91 4
palmdotax 0:f02641e3fb91 5
palmdotax 11:9df7ada37d31 6 DigitalOut dir1(PC_10);
palmdotax 11:9df7ada37d31 7 DigitalOut dir2(PC_12);
palmdotax 9:86701fec3f79 8 PwmOut speeds(PA_5);
palmdotax 9:86701fec3f79 9 DigitalOut dirr1(PB_6);
palmdotax 9:86701fec3f79 10 DigitalOut dirr2(PC_7);
palmdotax 9:86701fec3f79 11 PwmOut speeds2(PA_7);
palmdotax 9:86701fec3f79 12 DigitalOut relays(PA_8);
palmdotax 8:8fbc0c858875 13 void move:: movespeed_1(int dir,float setpoint,float spd)
palmdotax 0:f02641e3fb91 14 {
palmdotax 6:9ed82a812ece 15 double dc=0;
palmdotax 0:f02641e3fb91 16 if(dir==1)
palmdotax 0:f02641e3fb91 17 {
palmdotax 0:f02641e3fb91 18 dir1=1;
palmdotax 0:f02641e3fb91 19 dir2=0;
palmdotax 0:f02641e3fb91 20 }
palmdotax 0:f02641e3fb91 21 else
palmdotax 0:f02641e3fb91 22 {
palmdotax 0:f02641e3fb91 23 dir1=0;
palmdotax 0:f02641e3fb91 24 dir2=1;
palmdotax 0:f02641e3fb91 25 }
palmdotax 6:9ed82a812ece 26 dc=setpoint+spd;
palmdotax 6:9ed82a812ece 27 speeds.write(dc);
palmdotax 6:9ed82a812ece 28
palmdotax 0:f02641e3fb91 29
palmdotax 8:8fbc0c858875 30 }
palmdotax 8:8fbc0c858875 31 void move:: movespeed_2(int dir,float setpoint,float spd)
palmdotax 8:8fbc0c858875 32 {
palmdotax 8:8fbc0c858875 33 double dc=0;
palmdotax 8:8fbc0c858875 34 if(dir==1)
palmdotax 8:8fbc0c858875 35 {
palmdotax 8:8fbc0c858875 36 dirr1=1;
palmdotax 8:8fbc0c858875 37 dirr2=0;
palmdotax 8:8fbc0c858875 38 }
palmdotax 8:8fbc0c858875 39 else
palmdotax 8:8fbc0c858875 40 {
palmdotax 8:8fbc0c858875 41 dirr1=0;
palmdotax 8:8fbc0c858875 42 dirr2=1;
palmdotax 8:8fbc0c858875 43 }
palmdotax 8:8fbc0c858875 44 dc=setpoint+spd;
palmdotax 8:8fbc0c858875 45 speeds.write(dc);
palmdotax 8:8fbc0c858875 46
palmdotax 8:8fbc0c858875 47
palmdotax 9:86701fec3f79 48 }
palmdotax 9:86701fec3f79 49 void move::pump(int on_off)
palmdotax 9:86701fec3f79 50 {
palmdotax 9:86701fec3f79 51 relays=on_off;
palmdotax 0:f02641e3fb91 52 }