Zachary Sunberg / Mbed 2 deprecated SAILORSbot

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

robot.h@36:ae0fa5fea38f, 2016-07-12 (annotated)

Committer:
zsunberg
Date:
Tue Jul 12 04:01:41 2016 +0000
Revision:
36:ae0fa5fea38f
Parent:
32:7e518320305f
Child:
37:c31268270bb2
removed gains

Who changed what in which revision?

UserRevisionLine numberNew contents of line
zsunberg 0:9f058fe8cab5 1 #include <stdio.h>
zsunberg 0:9f058fe8cab5 2 #include <stdlib.h>
zsunberg 0:9f058fe8cab5 3 #include "mbed.h"
zsunberg 0:9f058fe8cab5 4 #include "m3pi.h"
zsunberg 0:9f058fe8cab5 5
zsunberg 0:9f058fe8cab5 6 #define BUF_SIZE 128
zsunberg 0:9f058fe8cab5 7 #define ERROR 1
zsunberg 0:9f058fe8cab5 8 #define OK 0
zsunberg 0:9f058fe8cab5 9
zsunberg 0:9f058fe8cab5 10 //max/min speed
zsunberg 30:ea511cd81f43 11 #define MAX 1.0
zsunberg 0:9f058fe8cab5 12 #define MIN 0.1
zsunberg 0:9f058fe8cab5 13
zsunberg 0:9f058fe8cab5 14 DigitalOut xbeeReset(p26); //reset on Xbee
zsunberg 0:9f058fe8cab5 15
zsunberg 0:9f058fe8cab5 16 Serial pc(USBTX, USBRX); // tx, rx, interface with PC
zsunberg 0:9f058fe8cab5 17 Serial xbee(p28, p27); //tx, rx, interface with xbee
zsunberg 0:9f058fe8cab5 18
zsunberg 0:9f058fe8cab5 19 DigitalOut led1(LED1);
zsunberg 0:9f058fe8cab5 20 DigitalOut led2(LED2);
zsunberg 0:9f058fe8cab5 21 DigitalOut led3(LED3);
zsunberg 0:9f058fe8cab5 22 DigitalOut led4(LED4);
zsunberg 0:9f058fe8cab5 23
zsunberg 20:f0ca65974329 24 m3pi pi;
zsunberg 20:f0ca65974329 25
zsunberg 32:7e518320305f 26 volatile int mode;
zsunberg 20:f0ca65974329 27 #define MANUAL_MODE 0
zsunberg 20:f0ca65974329 28 #define LINE_FOLLOW_MODE 1
zsunberg 23:55f8b1abbf99 29 #define TURN_MODE 2
zsunberg 31:e36b7722df56 30 #define NUDGE_MODE 3
zsunberg 20:f0ca65974329 31
Zachary Sunberg 25:c4577daa425a 32 bool comm_time;
Zachary Sunberg 25:c4577daa425a 33
zsunberg 20:f0ca65974329 34 volatile double leftspeed;
zsunberg 20:f0ca65974329 35 volatile double rightspeed;
zsunberg 30:ea511cd81f43 36 volatile double line_position;
zsunberg 20:f0ca65974329 37
zsunberg 30:ea511cd81f43 38 char received[1024];
zsunberg 20:f0ca65974329 39 int r_index;
zsunberg 20:f0ca65974329 40 int sensors[5];
zsunberg 20:f0ca65974329 41
Zachary Sunberg 29:6aa49bba0d81 42 // GAINS/Params
zsunberg 20:f0ca65974329 43 //////////////////////////////
zsunberg 36:ae0fa5fea38f 44 double k_p = 0.0;
zsunberg 30:ea511cd81f43 45 double k_i = 0.0;
zsunberg 36:ae0fa5fea38f 46 double k_d = 0.0;
zsunberg 31:e36b7722df56 47 double speed = 0.3;
zsunberg 20:f0ca65974329 48 //////////////////////////////
zsunberg 20:f0ca65974329 49
zsunberg 20:f0ca65974329 50 Ticker communication;
zsunberg 20:f0ca65974329 51 Ticker controls;