Fengrui Chenchen Zuo
3872 Play-live--test code - tempting to make this the main one
Diff: main.cpp
- Revision:
- 2:9296823ea33d
- Parent:
- 1:c704bea518d8
--- a/main.cpp Fri Oct 30 01:43:49 2020 +0000
+++ b/main.cpp Wed Nov 11 04:50:30 2020 +0000
@@ -1,49 +1,73 @@
-/*
-Copyright (c) 2011 Anthony Buckton (abuckton [at] blackink [dot} net {dot} au)
-
-Permission is hereby granted, free of charge, to any person obtaining a copy
-of this software and associated documentation files (the "Software"), to deal
-in the Software without restriction, including without limitation the rights
-to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
-copies of the Software, and to permit persons to whom the Software is
-furnished to do so, subject to the following conditions:
-
-The above copyright notice and this permission notice shall be included in
-all copies or substantial portions of the Software.
-
-THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
-IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
-FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
-AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
-LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
-OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
-THE SOFTWARE.
-*/
-
#include <mbed.h>
#include <string>
#include <list>
#include <mpr121.h>
#include "SongPlayer.h"
+#include "fastlib/clock.h"
+SongPlayer mySpeaker(p21);
+
+//fl_select_pll0_clock_source(1);
+//fl_pll0_control(1,1); //enable PLL clock
+//fl_pll0_config(1, 512); //Configure output clock freq.
+
+Timer t;
+Timer t_rest;
+Timer t_base;
+Timer reset_timer;
+Timer song_timer;
+bool timer_begin = 0;
+bool played = 0;
+uint16_t value = 0;
+float temp_value;
+PwmOut jawServo(p26);
+PwmOut baseServo(p25);
DigitalIn record_mode(p14);
DigitalIn play_back_mode(p16);
DigitalIn play_live_mode(p15);
-SongPlayer mySpeaker(p21);
-Timer t;
-Timer t_rest;
+DigitalIn stop_mode(p17);
+DigitalIn reset_mode(p20);
+DigitalOut greenLED(p23);
+DigitalOut redLED(p18);
+DigitalOut blueLED(p22);
+
-enum Statetype {IDLE = 0, REC = 1, PLAY_BACK = 2, PLAY_LIVE = 3, STOP = 4, RESET = 5};
+enum Statetype {IDLE = 0, REC = 1, PLAY_BACK = 2, PLAY_LIVE = 3, STOP = 4, RESET = 5};
+
+Statetype mode;
+
+float mem_note[160];
+float mem_duration[160];
+int mem_ind;
+float dt;
+float dur[1]= {0.5f};
-Statetype mode;
+class Watchdog
+{
+public:
+// Load timeout value in watchdog timer and enable
+ void kick(float s)
+ {
+ LPC_WDT->WDCLKSEL = 0x1; // Set CLK src to PCLK
+ uint32_t clk = SystemCoreClock / 16; // WD has a fixed /4 prescaler, PCLK default is /4
+ LPC_WDT->WDTC = s * (float)clk;
+ LPC_WDT->WDMOD = 0x3; // Enabled and Reset
+ kick();
+ }
+// "kick" or "feed" the dog - reset the watchdog timer
+// by writing this required bit pattern
+ void kick()
+ {
+ LPC_WDT->WDFEED = 0xAA;
+ LPC_WDT->WDFEED = 0x55;
+ }
+};
-float mem_note[160];
-float mem_duration[160];
-int mem_ind;
+Watchdog wdt;
// Create the interrupt receiver object on pin 26
-InterruptIn interrupt(p26);
+InterruptIn interrupt(p30);
// Setup the Serial to the PC for debugging
Serial pc(USBTX, USBRX);
@@ -55,14 +79,145 @@
// constructor(i2c object, i2c address of the mpr121)
Mpr121 mpr121(&i2c, Mpr121::ADD_VSS);
-void fallInterrupt() {
+float note = 0;
+
+float parse_key(uint16_t input)
+{
+ switch(input) {
+ case 0x0:
+ return 0.0;
+ case 0x1:
+ return 440.0;
+ case 0x2:
+ return 446.16;
+ case 0x4:
+ return 493.88;
+ case 0x8:
+ return 523.25;
+ case 0x10:
+ return 554.37;
+ case 0x20:
+ return 587.33;
+ case 0x40:
+ return 622.25;
+ case 0x80:
+ return 659.25;
+ case 0x100:
+ return 698.46;
+ case 0x200:
+ return 739.99;
+ case 0x400:
+ return 783.99;
+ case 0x800:
+ return 830.61;
+ default:
+ return 0.0;
+ }
+}
+
+void dance(uint16_t note_input)
+{
+
+ if(note_input == 0x1) {
+ redLED = 1;
+ greenLED = 0;
+ blueLED = 0;
+ jawServo.write(0.11f);
+ baseServo.write(0.11f);
+ } else if(note_input == 0x1) {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 0;
+ jawServo.write(0.18f);
+ baseServo.write(0.18f);
+ } else if(note_input == 0x2) {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.23f);
+ baseServo.write(0.23f);
+ } else if(note_input == 0x4) {
+ redLED = 0;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.28f);
+ baseServo.write(0.28f);
+ } else if(note_input == 0x8) {
+ redLED = 0;
+ greenLED = 0;
+ blueLED = 1;
+ jawServo.write(0.34f);
+ baseServo.write(0.34f);
+ } else if(note_input == 0x10) {
+ redLED = 0;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.39f);
+ baseServo.write(0.39f);
+ } else if(note_input == 0x20) {
+ redLED = 1;
+ greenLED = 0;
+ blueLED = 1;
+ jawServo.write(0.48f);
+ baseServo.write(0.48f);
+ } else if(note_input == 0x40) {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 0;
+ jawServo.write(0.55f);
+ baseServo.write(0.55f);
+ } else if(note_input == 0x80) {
+ redLED = 0;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.63f);
+ baseServo.write(0.63f);
+ } else if(note_input == 0x100) {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 0;
+ jawServo.write(0.73f);
+ baseServo.write(0.73f);
+ } else if(note_input == 0x200) {
+ redLED = 1;
+ greenLED = 0;
+ blueLED = 1;
+ jawServo.write(0.83f);
+ baseServo.write(0.83f);
+ } else if(note_input == 0x400) {
+ redLED = 1;
+ greenLED = 0;
+ blueLED = 1;
+ jawServo.write(0.88f);
+ baseServo.write(0.88f);
+ } else if(note_input == 0x800) {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.93f);
+ baseServo.write(0.93f);
+ } else {
+ redLED = 1;
+ greenLED = 1;
+ blueLED = 1;
+ jawServo.write(0.98f);
+ baseServo.write(0.98f);
+ }
+ //wait(0.45);
+}
+
+void fallInterrupt()
+{
//int key_code=0;
//int i=0;
+ //wdt.kick();
+ interrupt.fall(NULL);
+ t_rest.stop();
+ t.start();
uint16_t value=mpr121.read(0x00);
value +=mpr121.read(0x01)<<8;
- float temp_value = float(value);
- t_rest.stop();
- if(mode == REC && mem_ind < 160){
+ float temp_value = parse_key(value);
+ if(record_mode == 0 && mem_ind < 160){
//Write duration and silence in object
mem_note[mem_ind] = 0;
mem_duration[mem_ind] = t_rest.read();
@@ -71,27 +226,31 @@
}
pc.printf("The time of silence seconds %f \n", t_rest.read());
t_rest.reset();
- t.start();
- float note[] = {value + 150};
- if(mode == PLAY_LIVE || mode == REC){
+ wait(0.1);
+ float note = parse_key(value);
+ if(play_live_mode == 0 || record_mode == 0){
mySpeaker.Play_Note(note);
+ dance(note);
}
+ //wdt.kick();
//sustaining note
while(value > 0){
- if(mode == PLAY_LIVE || mode == REC){
+ if(play_live_mode == 0 || record_mode == 0){
mySpeaker.Play_Note(note);
}
+ wait(0.05);
pc.printf("MPR value: %x \r\n", value);
- note[0] = value + 150;
- if(mode == PLAY_LIVE || mode == REC){
+ note = parse_key(value);
+ if(play_live_mode == 0 || record_mode == 0){
mySpeaker.Play_Note(note);
}
value=mpr121.read(0x00);
value +=mpr121.read(0x01)<<8;
+ //wdt.kick();
}
mySpeaker.Play_Note(0);
t.stop();
- if(mode == REC && mem_ind < 160){
+ if(record_mode == 0 && mem_ind < 160){
mem_note[mem_ind] = temp_value;
mem_duration[mem_ind] = t.read();
pc.printf("New Data in memory: Note: %f Duration: %f\n", mem_note[mem_ind], mem_duration[mem_ind]);
@@ -101,37 +260,109 @@
float duration[] = {t.read()};
pc.printf("The of note seconds %f \n", t.read());
t.reset();
+ //wait(0.05);
+ interrupt.fall(&fallInterrupt);
+ interrupt.mode(PullUp);
+ //wdt.kick();
}
-int main() {
-
+
+int main()
+{
+ wait(1); //initialization
+ //pc.printf("SystemCoreClock = %d Hz\r\n", SystemCoreClock);
+ //wdt.kick(100);
+
+ //reset_mode.fall(&reset);
+ //reset_mode.rise(&reset_over);
+ //reset_mode.mode(PullUp);
+
+ jawServo.period_ms(20);
+ baseServo.period_ms(20);
interrupt.fall(&fallInterrupt);
interrupt.mode(PullUp);
while (1) {
- if(record_mode == 1){
- mode = REC;
- }
- if(play_back_mode == 1){
- mode = PLAY_BACK;
- }
- if(play_live_mode == 1){
- mode = PLAY_LIVE;
+ if(record_mode == 0 && reset_mode == 1) {
+ redLED = 1;
+ blueLED = 0;
+ greenLED = 0;
+ played = 0;
+ //wdt.kick();
+ } else if(play_back_mode == 0 && reset_mode == 1) {
+ note = 0;
+ redLED = 0;
+ blueLED = 1;
+ greenLED = 0;
+ interrupt.fall(NULL); //disable interrupt
+ //t.stop();
+ //t.reset();
+ //t_rest.stop();
+ //t_rest.reset();
+ for(int k = 0; k < mem_ind; k++) {
+ mySpeaker.Play_Note(mem_note[k]);
+ dance(mem_note[k]);
+ if(reset_mode == 0){
+ break;
+ }
+ wait(mem_duration[k]);
+ }
+ interrupt.fall(&fallInterrupt);
+ interrupt.mode(PullUp);
+ //wdt.kick();
+ } else if(play_live_mode == 0 && reset_mode == 1) {
+ note = 0;
+ redLED = 0;
+ blueLED = 0;
+ greenLED = 1;
+ played = 0;
+ //wdt.kick();
+ } else if(stop_mode == 0 && reset_mode == 1) {
+ note = 0;
+ redLED = 0;
+ blueLED = 0;
+ greenLED = 0;
+ //wdt.kick();
+ } else if(reset_mode == 0) {
+ //wdt.kick();
+ note = 0;
+ redLED = 0;
+ blueLED = 0;
+ greenLED = 0;
+ interrupt.fall(NULL);
+ mySpeaker.Play_Note(0);
+ if(!timer_begin) {
+ timer_begin = 1;
+ reset_timer.start();
+ }
+ while(reset_mode == 0) {
+
+ //t_base.stop();
+ //dt += t_base.read();
+ //t_base.reset();
+
+ //rotation orientation back to original position
+ //baseServo.pulsewidth_ms(1.9);
+ //wait(dt);
+ //dt = 0;
+ if(reset_timer.read() > 3) {
+ for(int n = 0; n < 160; n++) {
+ mem_note[n] = 0;
+ mem_duration[n] = 0;
+ }
+ }
+ //wdt.kick();
+ }
+ reset_timer.stop();
+ reset_timer.reset();
+ timer_begin = 1;
+ mem_ind = 0;
+ interrupt.fall(&fallInterrupt);
+ interrupt.mode(PullUp);
}
- switch (mode){
- case REC:
- break;
- case PLAY_BACK:
- interrupt.fall(NULL);
- mySpeaker.PlaySong(mem_note, mem_duration);
- wait(1);
- interrupt.fall(&fallInterrupt);
- break;
- case PLAY_LIVE:
-
- break;
- }
+ //wdt.kick();
}
}
+