Diversão do giroscópio com anel NeoPixel

Sobre este projeto

Etapa 1:Coisas necessárias

Etapa 2:montagem

Etapa 3:o código e a calibração

  #include "I2Cdev.h" #include  #include "MPU6050_6Axis_MotionApps20.h" #include "Wire.h" #define NEOPIXED_CONTROL_PIN 6 #define NUM_LEDS 24 const; const int LED_OFFSET =12; MPU6050 mpu; Tira Adafruit_NeoPixel =Adafruit_NeoPixel (NUM_LEDS, NEOPIXED_CONTROL_PIN, NEO_RBG + NEO_KHZ800); não assinado long lastPrintTime =0; inicialização bool =falso; // define verdadeiro se a inicialização DMP foi bem-sucedida uint8_t mpuIntStatus; // mantém o byte de status de interrupção real do MPU uint8_t devStatus; // retorna o status após cada operação do dispositivo (0 =sucesso,! 0 =erro) uint16_t packetSize; // tamanho do pacote DMP esperado (o padrão é 42 bytes) uint16_t fifoCount; // contagem de todos os bytes atualmente em FIFO uint8_t fifoBuffer [64]; // buffer de armazenamento FIFO Quaternion q; // [w, x, y, z] contêiner de quatérnio VectorFloat gravity; // [x, y, z] vetor de gravidade float ypr [3]; // [yaw, pitch, roll] yaw / pitch / roll container e vetor de gravidade volátil bool mpuInterrupt =false; // indica se o pino de interrupção MPU aumentou 

 

 void setup () {Serial.begin (9600); Serial.println ("Programa iniciado"); inicialização =inicializarGiroscópio (); strip.begin (); } void loop () {if (! inicialização) {return; } mpuInterrupt =false; mpuIntStatus =mpu.getIntStatus (); fifoCount =mpu.getFIFOCount (); if (hasFifoOverflown (mpuIntStatus, fifoCount)) {mpu.resetFIFO (); Retorna; } if (mpuIntStatus &0x02) {while (fifoCount  0) {lightLeds (y, z, 0, 5, 0, 89); } else if (y <0 e z <0) {lightLeds (y, z, 6, 12, 89, 0); } else if (y> 0 e z <0) {lightLeds (y, z, 13, 19, 0, 89); } else if (y> 0 ez> 0) {lightLeds (y, z, 20, 24, 89, 0); }} void lightLeds (int x, int y, int fromLedPosition, int toLedPosition, int fromAngle, int toAngle) {ângulo duplo =(atan ((duplo) abs (x) / (duplo) abs (y)) * 4068) / 71; int ledNr =mapa (ângulo, deAngle, toAngle, fromLedPosition, toLedPosition); printDebug (x, y, ledNr, ângulo); uint32_t color; para (int i =0; i  position + LED_OFFSET) {return position + LED_OFFSET; } posição de retorno + LED_OFFSET - NUM_LEDS; } void printDebug (int y, int z, int lightLed, int ângulo) {if (millis () - lastPrintTime <500) {return; } Serial.print ("a ="); Serial.print (ângulo); Serial.print (";"); Serial.print ("ll ="); Serial.print (lightLed); Serial.print (";"); Serial.print ("y ="); Serial.print (y); Serial.print (";"); Serial.print ("z ="); Serial.print (z); Serial.println (";"); lastPrintTime =millis (); } bool initializeGyroscope () {Wire.begin (); TWBR =24; mpu.initialize (); Serial.println (mpu.testConnection ()? F ("MPU6050 conexão bem-sucedida"):F ("MPU6050 conexão falhou")); Serial.println (F ("Inicializando DMP ...")); devStatus =mpu.dmpInitialize (); mpu.setXGyroOffset (220); mpu.setYGyroOffset (76); mpu.setZGyroOffset (-85); mpu.setZAccelOffset (1788); if (devStatus! =0) {Serial.print (F ("Falha na inicialização DMP (código")); Serial.println (devStatus); retornar falso;} mpu.setDMPEnabled (true); Serial.println (F ("Ativando detecção de interrupção (interrupção externa do Arduino 0) ... ")); attachInterrupt (0, dmpDataReady, RISING); mpuIntStatus =mpu.getIntStatus (); Serial.println (F (" DMP pronto! Aguardando a primeira interrupção ... " )); packetSize =mpu.dmpGetFIFOPacketSize (); retornar verdadeiro;} void dmpDataReady () {mpuInterrupt =true;}  

Etapa 4:como funciona (opcional)

Código

O código do Arduino

Esquemas