Revision 3:934d5e72990a, committed 2015-12-09

Comitter:

PKnevermind

Date:

Wed Dec 09 08:32:13 2015 +0000

Parent:

2:6f21eae5f456

Commit message:

VS1053

Changed in this revision

diff -r 6f21eae5f456 -r 934d5e72990a player.cpp
--- a/player.cpp	Tue Dec 08 19:52:11 2015 +0000
+++ b/player.cpp	Wed Dec 09 08:32:13 2015 +0000
@@ -1,19 +1,47 @@
 #include "player.h"
 #include "SDFileSystem.h"
+#include "MPU9250.h"
+#include "SPI_TFT_ILI9341.h"
+#include "stdio.h"
+#include "string"
+#include "Arial12x12.h"
+#include "Arial24x23.h"
+#include "Arial28x28.h"
+#include "font_big.h"
 
 SDFileSystem sd(D11, D12, D13, D9, "sd"); // the pinout on the mbed Cool
 vs10xx vs1053(D11, D12, D13, D6, D7, D2, D8 );//mosi,miso,sclk,xcs,xdcs,dreq,xreset
+DigitalOut red(A0);
+DigitalOut green(A2);
+DigitalOut blue(A1);
+DigitalIn Mode(A5);
 
+MPU9250 mpu9250;
 playerStatetype  playerState;
 ctrlStatetype ctrlState;
 static unsigned char fileBuf[65536];
 unsigned char *bufptr;
 
+extern unsigned char p1[];
+extern unsigned char p2[];
+extern unsigned char p3[];
+
 char list[20][50];          //song list
 char index = 0;      //song play index
 char index_MAX;      //how many song in all
 unsigned char vlume = 0x40;   //vlume
 unsigned char vlumeflag = 0;  //set vlume flag
+float sum = 0;
+uint32_t sumCount = 0;
+char buffer[14];
+uint8_t dato_leido[2];
+uint8_t whoami;
+Timer t;
+int check = 0;
+
+int mark=20;
+SPI_TFT_ILI9341 TFT(PA_7,PA_6,PA_5,PA_13,PA_14,PA_15,"TFT"); // mosi, miso, sclk, cs, reset, dc
+
 
 void Player::begin(void)
 {
@@ -34,7 +62,7 @@
                 while(*byte) {
                     list[i][j++]  = *byte++;
                 }
-                printf("%2d . %s\r\n", i,list[i++]);
+                printf("%2d . %s\r\n", i+1,list[i++]);
                 fp->close();
             }
         }
@@ -49,9 +77,11 @@
 {
     int bytes;        // How many bytes in buffer left
     int n;
+    int x=0;
+    check = mode();
 
     playerState = PS_PLAY;
-
+    GREEN();
     vs1053.setFreq(24000000);     //hight speed
     FileHandle *fp =sd.open(file, O_RDONLY);
     if(fp == NULL) {
@@ -65,20 +95,55 @@
 
             // actual audio data gets sent to VS10xx.
             while(bytes > 0) {
-                n = (bytes < 1)?bytes:1;
+                n = (bytes < 32)?bytes:32;
                 vs1053.writeData(bufptr,n);
                 bytes -= n;
                 bufptr += n;
                 if(playerState == PS_STOP)break;
-                while(playerState == PS_PAUSE);
+                else if(mode() != check){
+                    check = mode();
+                    if(mode() == 0)letplay();
+                    else print_list();
+                }
+                else if(!mode()) {
+                    if(getGY()>50){
+                        playerState = PS_PAUSE;
+                        cry();
+                    }
+                    else if(getGX()<-30) {
+                        playerState = PS_STOP;
+                        angry();
+                        x = 1;
+                    } else if(getGX()>30) {
+                        playerState = PS_STOP;
+                        angry();
+                        x = 2;
+                    }
+                }
+                while(playerState == PS_PAUSE) {
+                    wait(0.2);
+                    RED();
+                    if(getGY()<-50){
+                        playerState = PS_PLAY;
+                        GREEN();
+                    }
+                }
             }
             if(playerState == PS_STOP)break;
         }
         fp->close();
         vs1053.softReset();
     }
-    if(index != index_MAX)index++;
-    else index = 0;
+    if(x == 1|| x==0){
+        wait(0.6);
+        if(index != index_MAX)index++;
+        else index = 0;
+    }
+    else if(x == 2){
+        wait(0.6);
+        if(index != 0)index--;
+        else index = index_MAX;
+    }
 }
 
 void Set32(unsigned char *d, unsigned int n)
@@ -89,3 +154,260 @@
         n >>= 8;
     }
 }
+
+void Player::RED()
+{
+    red = 1;
+    green = 0;
+    blue = 0;
+}
+
+void Player::GREEN()
+{
+    red = 0 ;
+    green = 1;
+    blue = 0;
+}
+
+void Player::BLUE()
+{
+    red = 0;
+    green = 0;
+    blue = 1;
+}
+
+int Player::getGY()
+{
+    // If intPin goes high, all data registers have new data
+    if(mpu9250.readByte(MPU9250_ADDRESS, INT_STATUS) & 0x01) {  // On interrupt, check if data ready interrupt
+
+        mpu9250.readAccelData(accelCount);  // Read the x/y/z adc values
+        // Now we'll calculate the accleration value into actual g's
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading accelerometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            ax = (float)accelCount[0]*aRes - accelBias[0];  // get actual g value, this depends on scale being set
+            ay = (float)accelCount[1]*aRes - accelBias[1];
+            az = (float)accelCount[2]*aRes - accelBias[2];
+        }
+
+        mpu9250.readGyroData(gyroCount);  // Read the x/y/z adc values
+        // Calculate the gyro value into actual degrees per second
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading gyrometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            gx = (float)gyroCount[0]*gRes - gyroBias[0];  // get actual gyro value, this depends on scale being set
+            gy = (float)gyroCount[1]*gRes - gyroBias[1];
+            gz = (float)gyroCount[2]*gRes - gyroBias[2];
+        }
+
+        mpu9250.readMagData(magCount);  // Read the x/y/z adc values
+        // Calculate the magnetometer values in milliGauss
+        // Include factory calibration per data sheet and user environmental corrections
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading magnetometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            mx = (float)magCount[0]*mRes*magCalibration[0] - magbias[0];  // get actual magnetometer value, this depends on scale being set
+            my = (float)magCount[1]*mRes*magCalibration[1] - magbias[1];
+            mz = (float)magCount[2]*mRes*magCalibration[2] - magbias[2];
+        }
+
+        mpu9250.getCompassOrientation(orientation);
+    }
+
+    //Now = t.read_us();
+    //deltat = (float)((Now - lastUpdate)/1000000.0f) ; // set integration time by time elapsed since last filter update
+    //lastUpdate = Now;
+    //sum += deltat;
+    //sumCount++;
+
+    // Pass gyro rate as rad/s
+    // mpu9250.MadgwickQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f,  my,  mx, mz);
+    mpu9250.MahonyQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f, my, mx, mz);
+
+    return gy;
+}
+
+int Player::getGX()
+{
+    // If intPin goes high, all data registers have new data
+    if(mpu9250.readByte(MPU9250_ADDRESS, INT_STATUS) & 0x01) {  // On interrupt, check if data ready interrupt
+
+        mpu9250.readAccelData(accelCount);  // Read the x/y/z adc values
+        // Now we'll calculate the accleration value into actual g's
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading accelerometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            ax = (float)accelCount[0]*aRes - accelBias[0];  // get actual g value, this depends on scale being set
+            ay = (float)accelCount[1]*aRes - accelBias[1];
+            az = (float)accelCount[2]*aRes - accelBias[2];
+        }
+
+        mpu9250.readGyroData(gyroCount);  // Read the x/y/z adc values
+        // Calculate the gyro value into actual degrees per second
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading gyrometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            gx = (float)gyroCount[0]*gRes - gyroBias[0];  // get actual gyro value, this depends on scale being set
+            gy = (float)gyroCount[1]*gRes - gyroBias[1];
+            gz = (float)gyroCount[2]*gRes - gyroBias[2];
+        }
+
+        mpu9250.readMagData(magCount);  // Read the x/y/z adc values
+        // Calculate the magnetometer values in milliGauss
+        // Include factory calibration per data sheet and user environmental corrections
+        if (I2Cstate != 0) //error on I2C
+            printf("I2C error ocurred while reading magnetometer data. I2Cstate = %d \n\r", I2Cstate);
+        else { // I2C read or write ok
+            I2Cstate = 1;
+            mx = (float)magCount[0]*mRes*magCalibration[0] - magbias[0];  // get actual magnetometer value, this depends on scale being set
+            my = (float)magCount[1]*mRes*magCalibration[1] - magbias[1];
+            mz = (float)magCount[2]*mRes*magCalibration[2] - magbias[2];
+        }
+
+        mpu9250.getCompassOrientation(orientation);
+    }
+
+    //Now = t.read_us();
+    //deltat = (float)((Now - lastUpdate)/1000000.0f) ; // set integration time by time elapsed since last filter update
+    //lastUpdate = Now;
+    //sum += deltat;
+    //sumCount++;
+
+    // Pass gyro rate as rad/s
+    // mpu9250.MadgwickQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f,  my,  mx, mz);
+    mpu9250.MahonyQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f, my, mx, mz);
+
+    return gx;
+}
+
+void Player::setup()
+{
+//___ Set up I2C: use fast (400 kHz) I2C ___
+    i2c.frequency(400000);
+
+    printf("CPU SystemCoreClock is %d Hz\r\n", SystemCoreClock);
+
+    t.start(); // Timer ON
+
+    // Read the WHO_AM_I register, this is a good test of communication
+    whoami = mpu9250.readByte(MPU9250_ADDRESS, WHO_AM_I_MPU9250);
+
+    printf("I AM 0x%x\n\r", whoami);
+    printf("I SHOULD BE 0x71\n\r");
+    if (I2Cstate != 0) // error on I2C
+        printf("I2C failure while reading WHO_AM_I register");
+
+    if (whoami == 0x71) { // WHO_AM_I should always be 0x71
+        printf("MPU9250 WHO_AM_I is 0x%x\n\r", whoami);
+        printf("MPU9250 is online...\n\r");
+        sprintf(buffer, "0x%x", whoami);
+        wait(1);
+
+        mpu9250.resetMPU9250(); // Reset registers to default in preparation for device calibration
+
+        mpu9250.MPU9250SelfTest(SelfTest); // Start by performing self test and reporting values (accelerometer and gyroscope self test)
+
+        mpu9250.calibrateMPU9250(gyroBias, accelBias); // Calibrate gyro and accelerometer, load biases in bias registers
+
+        wait(2);
+
+        // Initialize device for active mode read of acclerometer, gyroscope, and temperature
+        mpu9250.initMPU9250();
+
+
+        // Initialize device for active mode read of magnetometer, 16 bit resolution, 100Hz.
+        mpu9250.initAK8963(magCalibration);
+        wait(1);
+    }
+
+    else { // Connection failure
+        while(1) ; // Loop forever if communication doesn't happen
+    }
+
+    mpu9250.getAres(); // Get accelerometer sensitivity
+    mpu9250.getGres(); // Get gyro sensitivity
+    mpu9250.getMres(); // Get magnetometer sensitivity
+    magbias[0] = +470.;  // User environmental x-axis correction in milliGauss, should be automatically calculated
+    magbias[1] = +120.;  // User environmental x-axis correction in milliGauss
+    magbias[2] = +125.;  // User environmental x-axis correction in milliGauss
+}
+
+int Player::mode()
+{
+    int m = Mode.read();
+    return m;
+}
+
+void Player::letplay()
+{
+    TFT.cls();
+    TFT.foreground(White);
+    TFT.background(Black);
+    TFT.cls();
+    TFT.set_orientation(1);
+    TFT.Bitmap(60,1,200,173,p1);
+}
+
+void Player::angry()
+{
+    TFT.cls();
+    TFT.foreground(White);
+    TFT.background(Black);
+    TFT.cls();
+    TFT.set_orientation(1);
+    TFT.Bitmap(60,1,200,173,p2);
+}
+
+void Player::cry()
+{
+    TFT.cls();
+    TFT.foreground(White);
+    TFT.background(Black);
+    TFT.cls();
+    TFT.set_orientation(1);
+    TFT.Bitmap(60,1,200,173,p3);
+}
+
+void Player::print_list()
+{
+    int a=0,b=0;
+    TFT.claim(stdout);
+    TFT.cls();
+    TFT.foreground(White);
+    TFT.background(Black);
+    TFT.cls();
+
+    TFT.set_orientation(3);
+    TFT.set_font((unsigned char*) Arial28x28);
+    TFT.locate(150,120);
+    TFT.printf("Manual Mode:");
+    TFT.cls();
+    TFT.set_orientation(3);
+    TFT.set_font((unsigned char*) Arial12x12);
+    //list[5]='\0';
+    do {
+        TFT.locate(5,b);
+        TFT.printf("%2d . %s\r\n", a+1,list[a]);
+        a++;
+        b=b+23;
+    } while(a<5);
+}
+
+void Player::select_list()
+{
+    if(mark>=96) {
+        mark=10;
+    }
+    TFT.cls();
+    print_list();
+    TFT.set_orientation(0);
+    TFT.fillcircle(mark,20,10,Red);
+
+    mark=mark+23;
+}

diff -r 6f21eae5f456 -r 934d5e72990a player.h
--- a/player.h	Tue Dec 08 19:52:11 2015 +0000
+++ b/player.h	Wed Dec 09 08:32:13 2015 +0000
@@ -25,9 +25,21 @@
 class Player
 {
 public:
-  void begin(void);
-  void playFile(char *file);
-  void recordFile(char *file);
+    void begin(void);
+    void playFile(char *file);
+    void RED();
+    void GREEN();
+    void BLUE();
+    void setup();
+    int getGX();
+    int getGY();
+    int mode();
+    void letplay();
+    void angry();
+    void cry();
+    void print_list();
+    void select_list();
+
 private:
     
 };