FRA221_B18
sxa
Dependents: MP3333 B18_MP3_PLAYER B18_MP3_PLAYER B18_MP3_PLAYER
Diff: player.cpp
- Revision:
- 3:934d5e72990a
- Parent:
- 2:6f21eae5f456
--- 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;
+}