Keith Liang
/
FP
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 mbed-rtos Motor HC_SR04_Ultrasonic_Library
Revision 0:8048099359db, committed 2020-11-30
- Comitter:
- keithliang8
- Date:
- Mon Nov 30 00:22:27 2020 +0000
- Commit message:
- 1
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/HC_SR04_Ultrasonic_Library.lib Mon Nov 30 00:22:27 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/ejteb/code/HC_SR04_Ultrasonic_Library/#e0f9c9fb4cf3
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Motor.lib Mon Nov 30 00:22:27 2020 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/simon/code/Motor/#f265e441bcd9
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/Speaker.h Mon Nov 30 00:22:27 2020 +0000
@@ -0,0 +1,19 @@
+#include "mbed.h"
+// a new class to play a note on Speaker based on PwmOut class
+class Speaker
+{
+public:
+ Speaker(PinName pin) : _pin(pin) {
+// _pin(pin) means pass pin to the Speaker Constructor
+ }
+// class method to play a note based on PwmOut class
+ void PlayNote(float frequency, float duration, float volume) {
+ _pin.period(1.0/frequency);
+ _pin = volume/2.0;
+ wait(duration);
+ _pin = 0.0;
+ }
+
+private:
+ PwmOut _pin;
+};
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon Nov 30 00:22:27 2020 +0000
@@ -0,0 +1,227 @@
+#include "mbed.h"
+//#include "wave_player.h"
+//#include "SDFileSystem.h"
+#include "Motor.h"
+#include "rtos.h"
+//#include "RGBLed.h"
+#include "ultrasonic.h"
+#include "Speaker.h"
+Speaker speak(p26); //Speaker
+Serial blue(p28,p27); //Bluetooth Module
+Motor A(p21, p5, p13); // pwm, fwd, rev, can brake Back Left
+Motor B(p22, p14, p8); // pwm, fwd, rev, can brake Back Right
+Motor C(p23, p11, p12); // pwm, fwd, rev, can brake Front Right
+Motor D(p24, p9, p10); // pwm, fwd, rev, can brake Front Left
+DigitalOut myled(LED2);
+//AnalogOut DACout(p18);
+//wave_player waver(&DACout);
+float RmotorSpeed = 0.0;
+float LmotorSpeed = 0.0;
+
+int triggerDist = 300;
+
+void dist(int distance)
+{
+ if(distance <= triggerDist) {
+ RmotorSpeed = 0.0;
+ LmotorSpeed = 0.0;
+ A.speed(LmotorSpeed);
+ B.speed(RmotorSpeed);
+ C.speed(RmotorSpeed);
+ D.speed(LmotorSpeed);
+ speak.PlayNote(500.0, 2, 0.2);
+ }
+}
+ultrasonic mu(p6, p7, .1, 1, &dist);
+
+void startSonar(void const* argument){
+ mu.startUpdates();
+ while(1) {
+ mu.checkDistance();
+ Thread::wait(50);
+ }
+}
+
+void turnRight(){
+ A.speed(0.5);
+ B.speed(-0.5);
+ C.speed(-0.5);
+ D.speed(0.5);
+ wait(1.05);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0);
+}
+void turnLeft(){
+ A.speed(-0.5);
+ B.speed(0.5);
+ C.speed(0.5);
+ D.speed(-0.5);
+ wait(1.2);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0);
+}
+
+int main()
+{
+ Thread thread1(startSonar);
+
+ char bnum = 0;
+ char bhit = 0;
+ while(1)
+ {
+
+ A.speed(LmotorSpeed);
+ B.speed(RmotorSpeed);
+ C.speed(RmotorSpeed);
+ D.speed(LmotorSpeed);
+
+ if (blue.getc() == '!') {
+ char cmd = blue.getc();
+ if (cmd == 'B') { //button data packet
+ bnum = blue.getc(); //button number
+ bhit = blue.getc(); //1=hit, 0=release
+ if (blue.getc() == char(~('!' + 'B' + bnum + bhit))) { //checksum OK?
+ switch (bnum) {
+ case '1': //number button 1
+ if (bhit=='1') {
+ //add hit code here
+ RmotorSpeed += 0.2;
+ LmotorSpeed += 0.2; // speed up
+ } else {
+ //add release code here
+ }
+ break;
+ case '2': //number button 2
+ if (bhit=='1') {
+ //add hit code here
+ } else {
+ //add release code here
+ LmotorSpeed -= 0.2;
+ RmotorSpeed -= 0.2;// slow down
+ }
+ break;
+ case '3': //number button 3
+ if (bhit=='1') {
+ //add hit code here
+ } else {
+ //add release code here
+ LmotorSpeed = 0.0;
+ RmotorSpeed = 0.0;
+ }
+ break;
+ case '4': //number button 4
+ if (bhit=='1') {
+ speak.PlayNote(969.0, .2, 0.2);
+ } else {
+ //add release code here
+
+ }
+ break;
+ case '5': //button 5 up arrow
+ if (bhit=='1') {
+ if(LmotorSpeed > 0 && RmotorSpeed > 0) {
+ }
+ else if(LmotorSpeed <= 0 && RmotorSpeed <= 0) {
+ LmotorSpeed = 0.4;
+ RmotorSpeed = 0.4;
+ }
+ } else {
+ //add release code here
+ }
+ break;
+ case '6': //button 6 down arrow
+ if (bhit=='1') {
+ if(LmotorSpeed < 0 && RmotorSpeed < 0) {
+
+ }
+ else if(LmotorSpeed >= 0 && RmotorSpeed >= 0) {
+ LmotorSpeed = -0.4;
+ RmotorSpeed = -0.4;
+ }
+ } else {
+ //add release code here
+ }
+ break;
+ case '7': //button 7 left arrow
+ if (bhit=='1') {
+ LmotorSpeed = 0.25*RmotorSpeed;
+ } else {
+ //add release code here
+ }
+ break;
+ case '8': //button 8 right arrow
+ if (bhit=='1') {
+ RmotorSpeed = 0.25*LmotorSpeed;
+ } else {
+ //add release code here
+ }
+ break;
+ default:
+ break;
+ }
+ }
+ }
+ else if (cmd == 'X') {
+ char first = blue.getc();
+ char second = blue.getc();
+ char comma = blue.getc();
+ char third = blue.getc();
+ char fourth = blue.getc();
+ int secondnum = second - '0';
+ float xdist = secondnum * .75;
+ int fourthnum = fourth - '0';
+ float ydist = fourthnum * .75;
+ if(third == '+'){
+ A.speed(0.5);
+ B.speed(0.5);
+ C.speed(0.5);
+ D.speed(0.5);
+ wait(ydist);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0);
+ }
+ else if(third == '-'){
+ A.speed(-0.5);
+ B.speed(-0.5);
+ C.speed(-0.5);
+ D.speed(-0.5);
+ wait(ydist);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0);
+ }
+ if(first == '+'){
+ turnRight();
+ A.speed(0.5);
+ B.speed(0.5);
+ C.speed(0.5);
+ D.speed(0.5);
+ wait(xdist);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0);
+ }
+ else if(first == '-'){
+ turnLeft();
+ A.speed(0.5);
+ B.speed(0.5);
+ C.speed(0.5);
+ D.speed(0.5);
+ wait(xdist);
+ A.speed(0);
+ B.speed(0);
+ C.speed(0);
+ D.speed(0); }
+
+ }
+ }
+ }
+}
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed-rtos.lib Mon Nov 30 00:22:27 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed-rtos/#5713cbbdb706
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Mon Nov 30 00:22:27 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed/builds/65be27845400 \ No newline at end of file