HEPTA2 9軸センサー

Dependencies:   Hepta2_9axis mbed

main.cpp

Committer:
hepta2ume
Date:
2017-07-19
Revision:
1:6ee85df13ebd
Parent:
0:91fc70cdd15d

File content as of revision 1:6ee85df13ebd:

#include "mbed.h"
#include"Hepta9axis.h"

//DigitalOut myled(LED1);
HeptaMPU9250 MPU9250(p28,p27,0xD0,0x18);
Serial pc(USBTX,USBRX);
int main()
{
    while(1) {
        float ax,ay,az;
        float gx,gy,gz;
        float mx,my,mz;
        char gxa[4],gya[4],gza[4],axa[4],aya[4],aza[4],mxa[4],mya[4],mza[4];
        int dsizea[4];
        MPU9250.sen_acc(&ax,&ay,&az);
        MPU9250.sen_gyro(&gx,&gy,&gz);
        MPU9250.sen_mag(&mx,&my,&mz);
        MPU9250.sen_acc_u16(axa,aya,aza,&dsizea[0]);
        MPU9250.sen_gyro_u16(gxa,gya,gza,&dsizea[1]);
        MPU9250.sen_mag_u16(mxa,mya,mza,&dsizea[2]);
        pc.printf("AX = %f,AY = %f,AZ = %f\r\n",ax,ay,az);
        pc.printf("GX = %f,GY = %f,GZ = %f\r\n",gx,gy,gz);
        pc.printf("MX = %f,MY = %f,MZ = %f\r\n",mx,my,mz);
        
        pc.printf("AX_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",axa[i]);           
        }
        pc.printf(",");
        pc.printf("AY_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",aya[i]);           
        }
        pc.printf(",");
        pc.printf("AZ_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",aza[i]);           
        }
        pc.printf("\r\n");
        
        pc.printf("GX_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",gxa[i]);           
        }
        pc.printf(",");
        pc.printf("GY_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",gya[i]);           
        }
        pc.printf(",");
        pc.printf("GZ_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",gza[i]);           
        }
        pc.printf("\r\n");
        pc.printf("MX_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",mxa[i]);           
        }
        pc.printf(",");
        pc.printf("MY_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",mya[i]);           
        }
        pc.printf(",");
        pc.printf("MZ_16 = ");
        for(int i=0; i<4; i++) {
            pc.printf("%c",mza[i]);           
        }
        pc.printf("\r\n");
        
    }
}