mirror of
https://github.com/EFeru/hoverboard-sideboard-hack-GD.git
synced 2025-07-27 01:29:32 +00:00
e9d74bea29
Major: - Improved UART Timeout: Apparently, the UART data Rx/Tx is quite unreliable (especially under motor load) leading to very often out-of-sync issues. This change allows to reset the DMA more often, leading to a faster re-sync of the UART transmission and thus avoiding UART timeout Minor: - added #define MPU_SENSOR_ENABLE to allow to enable/disable the MPU6050 sensor and save code size if the sensors is not needed - fixed the orientation in the Processing sketch - updated ReadMe
92 lines
2.2 KiB
Plaintext
92 lines
2.2 KiB
Plaintext
/*
|
|
hoverboard-sidebboard-hack MPU6050 IMU - 3D Visualization Example. Use with VARIANT_DEBUG.
|
|
Copyright (C) 2020-2021 Emanuel FERU
|
|
*/
|
|
import processing.serial.*;
|
|
import java.awt.event.KeyEvent;
|
|
import java.io.IOException;
|
|
|
|
Serial myPort;
|
|
float roll, pitch,yaw;
|
|
int idx = 0;
|
|
|
|
String data="";
|
|
String check="";
|
|
|
|
void setup() {
|
|
size (1400, 800, P3D);
|
|
printArray(Serial.list()); // List all the available serial ports
|
|
myPort = new Serial(this, "COM5", 38400); // starts the serial communication
|
|
myPort.bufferUntil('\n');
|
|
}
|
|
|
|
void draw() {
|
|
|
|
// If no data is received, send 'e' command to read the Euler angles
|
|
if(idx != -1 && myPort.available() == 0) {
|
|
idx++;
|
|
if(idx > 20) {
|
|
myPort.write('e');
|
|
idx = -1;
|
|
}
|
|
} else {
|
|
idx = -1;
|
|
}
|
|
|
|
// Display text
|
|
translate(width/2, height/2, 0); //<>//
|
|
background(51);
|
|
textSize(22);
|
|
text("Roll: " + roll + " Pitch: " + pitch + " Yaw: " + yaw, -200, 300);
|
|
|
|
// Rotate the object
|
|
rotateZ(radians(roll));
|
|
rotateX(radians(pitch));
|
|
rotateY(radians(yaw));
|
|
|
|
// 3D 0bject
|
|
// Draw box with text
|
|
fill(35, 133, 54); // Make board GREEN
|
|
box (426, 30, 220);
|
|
textSize(25);
|
|
fill(255, 255, 255);
|
|
text("MPU-6050 DMP DEMO", -150, 10, 111);
|
|
|
|
// Add other boxes
|
|
translate(-70, -18, -30);
|
|
fill(100, 100, 100);
|
|
box (20, 5, 20); // MPU-6050
|
|
|
|
translate(70, 0, 0);
|
|
box (40, 5, 40); // GD32
|
|
|
|
translate(0, 0, -70);
|
|
fill(255, 255, 255);
|
|
box (50, 40, 15); // USART Main
|
|
|
|
translate(0, 0, 200);
|
|
box (50, 40, 15); // Color Led connector
|
|
|
|
translate(-60, 0, 0);
|
|
box (40, 40, 15); // Blue Led connector
|
|
|
|
}
|
|
|
|
// Read data from the Serial Port
|
|
void serialEvent (Serial myPort) {
|
|
// reads the data from the Serial Port up to the character '\n' and puts it into the String variable "data".
|
|
data = myPort.readStringUntil('\n');
|
|
// if you got any bytes other than the linefeed:
|
|
if (data != null) {
|
|
data = trim(data);
|
|
// split the string at " " (character space)
|
|
String items[] = split(data, ' ');
|
|
if (items.length > 5) {
|
|
//--- Roll,Pitch in degrees
|
|
roll = float(items[2]) / 100;
|
|
pitch = float(items[4]) / 100;
|
|
yaw = float(items[6]) / 100;
|
|
}
|
|
}
|
|
}
|