Compare commits
No commits in common. "bmi160-visualization" and "master" have entirely different histories.
bmi160-vis
...
master
1
.gitignore
vendored
1
.gitignore
vendored
@ -7,6 +7,7 @@
|
|||||||
*.core
|
*.core
|
||||||
*.moc
|
*.moc
|
||||||
*.o
|
*.o
|
||||||
|
*.obj
|
||||||
*.orig
|
*.orig
|
||||||
*.rej
|
*.rej
|
||||||
*.so
|
*.so
|
||||||
|
@ -13,8 +13,11 @@ set(CMAKE_CXX_STANDARD 17)
|
|||||||
set(CMAKE_CXX_STANDARD_REQUIRED ON)
|
set(CMAKE_CXX_STANDARD_REQUIRED ON)
|
||||||
set(CMAKE_CXX_EXTENSIONS OFF)
|
set(CMAKE_CXX_EXTENSIONS OFF)
|
||||||
|
|
||||||
|
#find_package(OpenCL REQUIRED)
|
||||||
|
|
||||||
include_directories("${CMAKE_CURRENT_SOURCE_DIR}/include" "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/examples" "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui" ${EPOXY_INCLUDE_DIRS} ${ASSIMP_INCLUDE_DIRS} ${SDL2_INCLUDE_DIRS})
|
include_directories("${CMAKE_CURRENT_SOURCE_DIR}/include" "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/examples" "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui" ${EPOXY_INCLUDE_DIRS} ${ASSIMP_INCLUDE_DIRS} ${SDL2_INCLUDE_DIRS})
|
||||||
|
|
||||||
|
|
||||||
configure_file("shaders/2d-passthrough-vertex.glsl" "shaders/2d-passthrough-vertex.glsl" COPYONLY)
|
configure_file("shaders/2d-passthrough-vertex.glsl" "shaders/2d-passthrough-vertex.glsl" COPYONLY)
|
||||||
configure_file("shaders/fixed-red-fragment.glsl" "shaders/fixed-red-fragment.glsl" COPYONLY)
|
configure_file("shaders/fixed-red-fragment.glsl" "shaders/fixed-red-fragment.glsl" COPYONLY)
|
||||||
configure_file("shaders/triangle-gen-geometry.glsl" "shaders/triangle-gen-geometry.glsl" COPYONLY)
|
configure_file("shaders/triangle-gen-geometry.glsl" "shaders/triangle-gen-geometry.glsl" COPYONLY)
|
||||||
@ -29,9 +32,7 @@ configure_file("shaders/mesh-fragment.glsl" "shaders/mesh-fragment.glsl" COPYONL
|
|||||||
|
|
||||||
configure_file("models/coordinate-system/coordsys.obj" "coordinate-system/coordsys.obj" COPYONLY)
|
configure_file("models/coordinate-system/coordsys.obj" "coordinate-system/coordsys.obj" COPYONLY)
|
||||||
configure_file("models/coordinate-system/coordsys.mtl" "coordinate-system/coordsys.mtl" COPYONLY)
|
configure_file("models/coordinate-system/coordsys.mtl" "coordinate-system/coordsys.mtl" COPYONLY)
|
||||||
configure_file("models/bmi160/bmi160.obj" "bmi160/bmi160.obj" COPYONLY)
|
|
||||||
configure_file("models/bmi160/bmi160.mtl" "bmi160/bmi160.mtl" COPYONLY)
|
|
||||||
configure_file("models/bmi160/texture.png" "bmi160/texture.png" COPYONLY)
|
|
||||||
|
|
||||||
set(IMGUI_SOURCES "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/imgui.cpp"
|
set(IMGUI_SOURCES "${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/imgui.cpp"
|
||||||
"${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/imgui_draw.cpp"
|
"${CMAKE_CURRENT_SOURCE_DIR}/imgui-submodule/imgui/imgui_draw.cpp"
|
||||||
|
@ -1,7 +1,7 @@
|
|||||||
#ifndef GLOBALCANVASSETTINGS_H
|
#ifndef GLOBALCANVASSETTINGS_H
|
||||||
#define GLOBALCANVASSETTINGS_H
|
#define GLOBALCANVASSETTINGS_H
|
||||||
|
|
||||||
#include <glm/glm.hpp>
|
//#include <glm/glm.hpp>
|
||||||
|
|
||||||
class GlobalCanvasSettings
|
class GlobalCanvasSettings
|
||||||
{
|
{
|
||||||
|
@ -1,47 +0,0 @@
|
|||||||
#ifndef _IMU_SERIAL_HPP_
|
|
||||||
#define _IMU_SERIAL_HPP_
|
|
||||||
|
|
||||||
#include <string>
|
|
||||||
#include <glm/glm.hpp>
|
|
||||||
#include <glm/gtc/quaternion.hpp>
|
|
||||||
#include <mutex>
|
|
||||||
#include <thread>
|
|
||||||
|
|
||||||
class ImuSerial
|
|
||||||
{
|
|
||||||
public:
|
|
||||||
ImuSerial(const std::string &serial_device, unsigned int baud);
|
|
||||||
~ImuSerial();
|
|
||||||
void start();
|
|
||||||
void stop();
|
|
||||||
|
|
||||||
void set_device(const std::string &device);
|
|
||||||
void set_baudrate(const unsigned int baud);
|
|
||||||
unsigned int get_baudrate();
|
|
||||||
const std::string &get_device();
|
|
||||||
bool runs();
|
|
||||||
glm::quat get_quaternion();
|
|
||||||
glm::vec3 get_accel();
|
|
||||||
glm::vec3 get_gyro();
|
|
||||||
const glm::mat4 get_rot_matrix();
|
|
||||||
|
|
||||||
private:
|
|
||||||
std::string serial_device;
|
|
||||||
unsigned int baud;
|
|
||||||
std::mutex quat_mutex;
|
|
||||||
std::mutex acc_mutex;
|
|
||||||
std::mutex gyr_mutex;
|
|
||||||
glm::quat quaternion;
|
|
||||||
glm::vec3 acc;
|
|
||||||
glm::vec3 gyr;
|
|
||||||
std::thread worker;
|
|
||||||
int stop_flag;
|
|
||||||
int fd;
|
|
||||||
friend void working_thread(ImuSerial *self);
|
|
||||||
friend void update_quaternion(ImuSerial *self, const glm::quat &quat);
|
|
||||||
friend void update_acc_value(ImuSerial *self, const glm::vec3 &acc);
|
|
||||||
friend void update_gyr_value(ImuSerial *self, const glm::vec3 &gyr);
|
|
||||||
};
|
|
||||||
|
|
||||||
|
|
||||||
#endif /* _IMU_SERIAL_HPP_ */
|
|
@ -4,7 +4,7 @@
|
|||||||
#include <string>
|
#include <string>
|
||||||
#include <epoxy/gl.h>
|
#include <epoxy/gl.h>
|
||||||
#include <opengl-playground/openglshader.hpp>
|
#include <opengl-playground/openglshader.hpp>
|
||||||
#include <glm/glm.hpp>
|
//#include <glm/glm.hpp>
|
||||||
#include <memory>
|
#include <memory>
|
||||||
|
|
||||||
class OpenGlGraphics
|
class OpenGlGraphics
|
||||||
|
@ -1,13 +0,0 @@
|
|||||||
# Blender MTL File: 'bmi160.blend1'
|
|
||||||
# Material Count: 1
|
|
||||||
|
|
||||||
newmtl Material
|
|
||||||
Ns 323.999994
|
|
||||||
Ka 1.000000 1.000000 1.000000
|
|
||||||
Kd 0.800000 0.800000 0.800000
|
|
||||||
Ks 0.500000 0.500000 0.500000
|
|
||||||
Ke 0.000000 0.000000 0.000000
|
|
||||||
Ni 1.450000
|
|
||||||
d 1.000000
|
|
||||||
illum 2
|
|
||||||
map_Kd texture.png
|
|
@ -1,40 +0,0 @@
|
|||||||
# Blender v2.83.2 OBJ File: 'bmi160.blend1'
|
|
||||||
# www.blender.org
|
|
||||||
mtllib bmi160.mtl
|
|
||||||
o Cube
|
|
||||||
v 1.250000 0.400000 -1.500000
|
|
||||||
v 1.250000 -0.400000 -1.500000
|
|
||||||
v 1.250000 0.400000 1.500000
|
|
||||||
v 1.250000 -0.400000 1.500000
|
|
||||||
v -1.250000 0.400000 -1.500000
|
|
||||||
v -1.250000 -0.400000 -1.500000
|
|
||||||
v -1.250000 0.400000 1.500000
|
|
||||||
v -1.250000 -0.400000 1.500000
|
|
||||||
vt 0.575745 0.121275
|
|
||||||
vt 0.575745 0.500000
|
|
||||||
vt 0.121275 0.500000
|
|
||||||
vt 0.121275 0.121275
|
|
||||||
vt 0.121275 0.999916
|
|
||||||
vt 0.000084 0.999917
|
|
||||||
vt 0.000083 0.621192
|
|
||||||
vt 0.121275 0.621192
|
|
||||||
vt 0.575745 0.621192
|
|
||||||
vt 0.575745 0.999917
|
|
||||||
vt 0.575745 0.000083
|
|
||||||
vt 0.121275 0.000083
|
|
||||||
vt 0.696937 0.621192
|
|
||||||
vt 0.696937 0.999917
|
|
||||||
vn 0.0000 1.0000 0.0000
|
|
||||||
vn 0.0000 0.0000 1.0000
|
|
||||||
vn -1.0000 0.0000 0.0000
|
|
||||||
vn 0.0000 -1.0000 0.0000
|
|
||||||
vn 1.0000 0.0000 0.0000
|
|
||||||
vn 0.0000 0.0000 -1.0000
|
|
||||||
usemtl Material
|
|
||||||
s off
|
|
||||||
f 1/1/1 5/2/1 7/3/1 3/4/1
|
|
||||||
f 4/5/2 3/6/2 7/7/2 8/8/2
|
|
||||||
f 8/8/3 7/3/3 5/2/3 6/9/3
|
|
||||||
f 6/9/4 2/10/4 4/5/4 8/8/4
|
|
||||||
f 2/11/5 1/1/5 3/4/5 4/12/5
|
|
||||||
f 6/9/6 5/13/6 1/14/6 2/10/6
|
|
Binary file not shown.
Before Width: | Height: | Size: 35 KiB |
Binary file not shown.
Before Width: | Height: | Size: 22 KiB |
File diff suppressed because it is too large
Load Diff
@ -1,298 +0,0 @@
|
|||||||
#include <opengl-playground/imu-serial.hpp>
|
|
||||||
#include <iostream>
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <string.h>
|
|
||||||
// Linux headers
|
|
||||||
#include <fcntl.h> // Contains file controls like O_RDWR
|
|
||||||
#include <errno.h> // Error integer and strerror() function
|
|
||||||
#include <termios.h> // Contains POSIX terminal control definitions
|
|
||||||
#include <unistd.h> // write(), read(), close()
|
|
||||||
#include <chrono>
|
|
||||||
#include <string>
|
|
||||||
|
|
||||||
ImuSerial::ImuSerial(const std::string &serial_device, unsigned int baud)
|
|
||||||
{
|
|
||||||
this->quaternion = glm::quat(1.0f, 0.0f, 0.0f, 0.0f);
|
|
||||||
this->serial_device = serial_device;
|
|
||||||
this->baud = baud;
|
|
||||||
fd = -1;
|
|
||||||
stop_flag = 0;
|
|
||||||
|
|
||||||
this->acc = this->gyr = glm::vec3(0.0f, 0.0f, 0.0f);
|
|
||||||
}
|
|
||||||
|
|
||||||
ImuSerial::~ImuSerial()
|
|
||||||
{
|
|
||||||
if (this->fd >= 0)
|
|
||||||
this->stop();
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static speed_t baudrate(int baud)
|
|
||||||
{
|
|
||||||
switch (baud) {
|
|
||||||
case 9600:
|
|
||||||
return B9600;
|
|
||||||
case 19200:
|
|
||||||
return B19200;
|
|
||||||
case 38400:
|
|
||||||
return B38400;
|
|
||||||
case 57600:
|
|
||||||
return B57600;
|
|
||||||
case 115200:
|
|
||||||
return B115200;
|
|
||||||
case 230400:
|
|
||||||
return B230400;
|
|
||||||
case 460800:
|
|
||||||
return B460800;
|
|
||||||
case 500000:
|
|
||||||
return B500000;
|
|
||||||
case 576000:
|
|
||||||
return B576000;
|
|
||||||
case 921600:
|
|
||||||
return B921600;
|
|
||||||
case 1000000:
|
|
||||||
return B1000000;
|
|
||||||
case 1152000:
|
|
||||||
return B1152000;
|
|
||||||
case 1500000:
|
|
||||||
return B1500000;
|
|
||||||
case 2000000:
|
|
||||||
return B2000000;
|
|
||||||
case 2500000:
|
|
||||||
return B2500000;
|
|
||||||
case 3000000:
|
|
||||||
return B3000000;
|
|
||||||
case 3500000:
|
|
||||||
return B3500000;
|
|
||||||
case 4000000:
|
|
||||||
return B4000000;
|
|
||||||
default:
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int open_serial(const char *serdev, unsigned int baud)
|
|
||||||
{
|
|
||||||
int fd;
|
|
||||||
struct termios tty;
|
|
||||||
|
|
||||||
fd = open(serdev, O_RDWR);
|
|
||||||
memset(&tty, 0, sizeof(tty));
|
|
||||||
|
|
||||||
if (fd < 0) {
|
|
||||||
std::cout << "Serial port not found or cannot be opened" << std::endl;
|
|
||||||
return fd;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (tcgetattr(fd, &tty) != 0) {
|
|
||||||
std::cout << "Error getting serial configuration" << std::endl;
|
|
||||||
close(fd);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
tty.c_cflag &= ~PARENB;
|
|
||||||
tty.c_cflag &= ~CSTOPB;
|
|
||||||
tty.c_cflag |= CS8;
|
|
||||||
tty.c_cflag &= ~CRTSCTS;
|
|
||||||
tty.c_cflag |= CREAD | CLOCAL;
|
|
||||||
tty.c_lflag &= ~ICANON;
|
|
||||||
tty.c_lflag &= ~ECHO; // Disable echo
|
|
||||||
tty.c_lflag &= ~ECHOE; // Disable erasure
|
|
||||||
tty.c_lflag &= ~ECHONL; // Disable new-line echo
|
|
||||||
tty.c_lflag &= ~ISIG; // Disable interpretation of INTR, QUIT and SUSP
|
|
||||||
tty.c_lflag &= ~ISIG; // Disable interpretation of INTR, QUIT and SUSP
|
|
||||||
tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL); // Disable any special handling of received bytes
|
|
||||||
tty.c_oflag &= ~OPOST; // Prevent special interpretation of output bytes (e.g. newline chars)
|
|
||||||
tty.c_oflag &= ~ONLCR; // Prevent conversion of newline to carriage return/line feed
|
|
||||||
tty.c_cc[VTIME] = 0; // Wait for up to 1s (10 deciseconds), returning as soon as any data is received.
|
|
||||||
tty.c_cc[VMIN] = 0;
|
|
||||||
|
|
||||||
cfsetispeed(&tty, baudrate(baud));
|
|
||||||
if (tcsetattr(fd, TCSANOW, &tty) != 0) {
|
|
||||||
std::cout << "Error setting serial config" << std::endl;
|
|
||||||
}
|
|
||||||
|
|
||||||
return fd;
|
|
||||||
}
|
|
||||||
|
|
||||||
float parse_buffer(const std::string &str)
|
|
||||||
{
|
|
||||||
return std::stof(str);
|
|
||||||
}
|
|
||||||
|
|
||||||
void update_quaternion(ImuSerial *self, const glm::quat &quat)
|
|
||||||
{
|
|
||||||
std::lock_guard(self->quat_mutex);
|
|
||||||
self->quaternion = quat;
|
|
||||||
}
|
|
||||||
|
|
||||||
void update_acc_value(ImuSerial *self, const glm::vec3 &acc)
|
|
||||||
{
|
|
||||||
std::lock_guard(self->acc_mutex);
|
|
||||||
self->acc = acc;
|
|
||||||
}
|
|
||||||
|
|
||||||
void update_gyr_value(ImuSerial *self, const glm::vec3 &gyr)
|
|
||||||
{
|
|
||||||
std::lock_guard(self->gyr_mutex);
|
|
||||||
self->gyr = gyr;
|
|
||||||
}
|
|
||||||
|
|
||||||
void working_thread(ImuSerial *self)
|
|
||||||
{
|
|
||||||
using namespace std::literals::chrono_literals;
|
|
||||||
char state = 0;
|
|
||||||
std::string buffer;
|
|
||||||
char data;
|
|
||||||
float value;
|
|
||||||
glm::quat quat;
|
|
||||||
glm::vec3 acc;
|
|
||||||
glm::vec3 gyr;
|
|
||||||
|
|
||||||
quat = self->get_quaternion();
|
|
||||||
|
|
||||||
while (!self->stop_flag) {
|
|
||||||
if (read(self->fd, &data, 1) == 1) {
|
|
||||||
if (state == 0) {
|
|
||||||
switch (data) {
|
|
||||||
case 'W':
|
|
||||||
case 'I':
|
|
||||||
case 'K':
|
|
||||||
case 'J':
|
|
||||||
case 'x':
|
|
||||||
case 'y':
|
|
||||||
case 'z':
|
|
||||||
case 'X':
|
|
||||||
case 'Y':
|
|
||||||
case 'Z':
|
|
||||||
state = data;
|
|
||||||
buffer = "";
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
if (data == '\n') {
|
|
||||||
try {
|
|
||||||
value = parse_buffer(buffer);
|
|
||||||
switch (state) {
|
|
||||||
case 'W':
|
|
||||||
quat.w = value;
|
|
||||||
break;
|
|
||||||
case 'I':
|
|
||||||
quat.x = value;
|
|
||||||
break;
|
|
||||||
case 'J':
|
|
||||||
quat.y = value;
|
|
||||||
break;
|
|
||||||
case 'K':
|
|
||||||
quat.z = value;
|
|
||||||
update_quaternion(self, quat);
|
|
||||||
break;
|
|
||||||
case 'x':
|
|
||||||
acc.x = value;
|
|
||||||
break;
|
|
||||||
case 'y':
|
|
||||||
acc.y = value;
|
|
||||||
break;
|
|
||||||
case 'z':
|
|
||||||
acc.z = value;
|
|
||||||
update_acc_value(self, acc);
|
|
||||||
break;
|
|
||||||
case 'X':
|
|
||||||
gyr.x = value;
|
|
||||||
break;
|
|
||||||
case 'Y':
|
|
||||||
gyr.y = value;
|
|
||||||
break;
|
|
||||||
case 'Z':
|
|
||||||
gyr.z = value;
|
|
||||||
update_gyr_value(self, gyr);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
} catch(...) {
|
|
||||||
std::cerr << "Invalid data received: " << buffer << std::endl;
|
|
||||||
}
|
|
||||||
state = 0;
|
|
||||||
} else {
|
|
||||||
buffer = buffer.append(&data, 1);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
} else {
|
|
||||||
std::this_thread::sleep_for(50us);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void ImuSerial::start()
|
|
||||||
{
|
|
||||||
this->fd = open_serial(this->serial_device.c_str(), this->baud);
|
|
||||||
if (this->fd >= 0) {
|
|
||||||
stop_flag = 0;
|
|
||||||
worker = std::thread(working_thread, this);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void ImuSerial::stop()
|
|
||||||
{
|
|
||||||
stop_flag = 1;
|
|
||||||
if (worker.joinable())
|
|
||||||
worker.join();
|
|
||||||
|
|
||||||
if (this->fd >= 0) {
|
|
||||||
close(this->fd);
|
|
||||||
this->fd = -1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void ImuSerial::set_device(const std::string &device)
|
|
||||||
{
|
|
||||||
this->serial_device = device;
|
|
||||||
}
|
|
||||||
|
|
||||||
void ImuSerial::set_baudrate(const unsigned int baud)
|
|
||||||
{
|
|
||||||
this->baud = baud;
|
|
||||||
}
|
|
||||||
|
|
||||||
unsigned int ImuSerial::get_baudrate()
|
|
||||||
{
|
|
||||||
return this->baud;
|
|
||||||
}
|
|
||||||
|
|
||||||
const std::string &ImuSerial::get_device()
|
|
||||||
{
|
|
||||||
return this->serial_device;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool ImuSerial::runs()
|
|
||||||
{
|
|
||||||
if (this->worker.joinable() && this->stop_flag == 0)
|
|
||||||
return true;
|
|
||||||
else
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
glm::quat ImuSerial::get_quaternion()
|
|
||||||
{
|
|
||||||
std::lock_guard(this->quat_mutex);
|
|
||||||
glm::quat ret_val = this->quaternion;
|
|
||||||
|
|
||||||
return ret_val;
|
|
||||||
}
|
|
||||||
|
|
||||||
glm::vec3 ImuSerial::get_accel()
|
|
||||||
{
|
|
||||||
std::lock_guard(this->acc_mutex);
|
|
||||||
return this->acc;
|
|
||||||
}
|
|
||||||
|
|
||||||
glm::vec3 ImuSerial::get_gyro()
|
|
||||||
{
|
|
||||||
std::lock_guard(this->gyr_mutex);
|
|
||||||
return this->gyr;
|
|
||||||
}
|
|
||||||
|
|
||||||
const glm::mat4 ImuSerial::get_rot_matrix()
|
|
||||||
{
|
|
||||||
return glm::mat4_cast(this->get_quaternion());
|
|
||||||
}
|
|
146
src/main.cpp
146
src/main.cpp
@ -4,50 +4,16 @@
|
|||||||
#include <opengl-playground/textured-rectangle.hpp>
|
#include <opengl-playground/textured-rectangle.hpp>
|
||||||
#include <opengl-playground/globalcanvassettings.hpp>
|
#include <opengl-playground/globalcanvassettings.hpp>
|
||||||
|
|
||||||
//#include <glm/glm.hpp>
|
#include <glm/glm.hpp>
|
||||||
#include <glm/gtc/matrix_transform.hpp>
|
#include <glm/gtc/matrix_transform.hpp>
|
||||||
#include <opengl-playground/model.hpp>
|
#include <opengl-playground/model.hpp>
|
||||||
#include <opengl-playground/imu-serial.hpp>
|
|
||||||
|
|
||||||
#include <imgui.h>
|
#include <imgui.h>
|
||||||
#include <imgui_impl_sdl.h>
|
#include <imgui_impl_sdl.h>
|
||||||
#include <imgui_impl_opengl3.h>
|
#include <imgui_impl_opengl3.h>
|
||||||
|
|
||||||
#define WINDOW_WIDTH 1500
|
#define WINDOW_WIDTH 1200
|
||||||
#define WINDOW_HEIGHT 1000
|
#define WINDOW_HEIGHT 800
|
||||||
|
|
||||||
static void handle_serial_port_gui(ImuSerial &imu_comm)
|
|
||||||
{
|
|
||||||
static char foo[512] = {0};
|
|
||||||
static int baud_rate;
|
|
||||||
static bool first = true;
|
|
||||||
bool runs = imu_comm.runs();
|
|
||||||
|
|
||||||
|
|
||||||
if (first) {
|
|
||||||
imu_comm.get_device().copy(foo, sizeof(foo), 0);
|
|
||||||
baud_rate = imu_comm.get_baudrate();
|
|
||||||
first = false;
|
|
||||||
}
|
|
||||||
|
|
||||||
ImGui::Begin("Serial Config");
|
|
||||||
ImGui::InputText("Serial Device", foo, sizeof(foo));
|
|
||||||
ImGui::InputInt("Baudrate", &baud_rate);
|
|
||||||
bool button = ImGui::Button((runs ? "Stop" : "Start"));
|
|
||||||
ImGui::Text("(c) Mario Huettel, GPLv2");
|
|
||||||
ImGui::End();
|
|
||||||
|
|
||||||
if (button) {
|
|
||||||
if (runs) {
|
|
||||||
imu_comm.stop();
|
|
||||||
} else {
|
|
||||||
imu_comm.set_device(std::string(foo));
|
|
||||||
imu_comm.set_baudrate((unsigned int)baud_rate);
|
|
||||||
imu_comm.start();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
int main(int argc, char **argv)
|
int main(int argc, char **argv)
|
||||||
{
|
{
|
||||||
@ -56,6 +22,7 @@ int main(int argc, char **argv)
|
|||||||
SdlMainWindow *window;
|
SdlMainWindow *window;
|
||||||
bool run = true;
|
bool run = true;
|
||||||
glm::mat4 projection_matrix;
|
glm::mat4 projection_matrix;
|
||||||
|
glm::vec4 color = glm::vec4(1.0f);
|
||||||
float fov_angle = 45.0f;
|
float fov_angle = 45.0f;
|
||||||
|
|
||||||
|
|
||||||
@ -90,25 +57,16 @@ int main(int argc, char **argv)
|
|||||||
|
|
||||||
auto shader = std::make_shared<OpenGlShaderProgram>("shaders/mesh-vertex.glsl", "", "shaders/mesh-fragment.glsl");
|
auto shader = std::make_shared<OpenGlShaderProgram>("shaders/mesh-vertex.glsl", "", "shaders/mesh-fragment.glsl");
|
||||||
shader->compile();
|
shader->compile();
|
||||||
//Model imu("/tmp/imu.obj", glm::vec4(1.0f, 0.0f, 0.0f, 1.0f), shader);
|
Model m("nanosuit/nanosuit.obj", glm::vec4(1.0f, 0.0f, 0.0f, 1.0f), shader);
|
||||||
|
|
||||||
Model coords("coordinate-system/coordsys.obj", glm::vec4(1.0f, 0.0f, 0.0f, 1.0f), shader);
|
Model coords("coordinate-system/coordsys.obj", glm::vec4(1.0f, 0.0f, 0.0f, 1.0f), shader);
|
||||||
|
|
||||||
coords.realize();
|
coords.realize();
|
||||||
|
m.realize();
|
||||||
Model imu("bmi160/bmi160.obj", glm::vec4(1.0f, 0.0f, 0.0f, 1.0f), shader);
|
m.setModelMatrix(glm::scale(glm::mat4(1.0f), glm::vec3(0.2f, 0.2f, 0.2f)));
|
||||||
|
|
||||||
imu.realize();
|
|
||||||
|
|
||||||
auto imu_base_mat = glm::translate(glm::mat4(1.0f), glm::vec3(2.0,0.0,0.0));
|
|
||||||
imu.setModelMatrix(imu_base_mat);
|
|
||||||
auto imu_correction_matrix = glm::rotate(glm::mat4(1.0f), glm::radians(90.0f), glm::vec3(1.0f, 0.0f, 0.0f));
|
|
||||||
auto imu_correction_inverse = glm::inverse(imu_correction_matrix);
|
|
||||||
|
|
||||||
glEnable(GL_DEPTH_TEST);
|
glEnable(GL_DEPTH_TEST);
|
||||||
|
|
||||||
auto imu_serial = ImuSerial("/dev/ttyUSB0", 115200);
|
|
||||||
|
|
||||||
while (run) {
|
while (run) {
|
||||||
|
|
||||||
SDL_Event event;
|
SDL_Event event;
|
||||||
@ -142,11 +100,9 @@ int main(int argc, char **argv)
|
|||||||
ImGui_ImplSDL2_NewFrame(window->getWindow());
|
ImGui_ImplSDL2_NewFrame(window->getWindow());
|
||||||
ImGui::NewFrame();
|
ImGui::NewFrame();
|
||||||
|
|
||||||
handle_serial_port_gui(imu_serial);
|
|
||||||
|
|
||||||
ImGui::Begin("Camera");
|
ImGui::Begin("Camera");
|
||||||
|
|
||||||
static float cam_rot_y = 0.0f;
|
|
||||||
static int e = 1;
|
static int e = 1;
|
||||||
ImGui::RadioButton("Orthographic", &e, 0); ImGui::SameLine();
|
ImGui::RadioButton("Orthographic", &e, 0); ImGui::SameLine();
|
||||||
ImGui::RadioButton("Perspective", &e, 1);
|
ImGui::RadioButton("Perspective", &e, 1);
|
||||||
@ -155,18 +111,11 @@ int main(int argc, char **argv)
|
|||||||
ImGui::SliderFloat("Camera x", &view_x, -20.0f, 20.0f);
|
ImGui::SliderFloat("Camera x", &view_x, -20.0f, 20.0f);
|
||||||
ImGui::SliderFloat("Camera y", &view_y, -20.0f, 20.0f);
|
ImGui::SliderFloat("Camera y", &view_y, -20.0f, 20.0f);
|
||||||
ImGui::SliderFloat("Camera z", &view_z, 0.0f, 20.0f);
|
ImGui::SliderFloat("Camera z", &view_z, 0.0f, 20.0f);
|
||||||
ImGui::SliderFloat("Camera y rot", &cam_rot_y, -180.0, 180.0);
|
|
||||||
ImGui::SliderFloat("Camera FOV", &fov_angle, 1.0f, 60.0f);
|
ImGui::SliderFloat("Camera FOV", &fov_angle, 1.0f, 60.0f);
|
||||||
ImGui::Text("Framerate: %.01f Hz", io.Framerate);
|
ImGui::Text("Framerate: %.01f Hz", io.Framerate);
|
||||||
|
|
||||||
|
GlobalCanvasSettings::setCameraPosition(glm::vec3(view_x, view_y, view_z));
|
||||||
auto camera_rotation = glm::rotate(glm::mat4(1.0f),
|
const glm::mat4 view = glm::lookAt(GlobalCanvasSettings::getCameraPosition(),
|
||||||
glm::radians(cam_rot_y),
|
|
||||||
glm::vec3(0.0f, 1.0f, 0.0f));
|
|
||||||
|
|
||||||
auto camera_pos = camera_rotation * glm::vec4(view_x, view_y, view_z, 1.0f);
|
|
||||||
GlobalCanvasSettings::setCameraPosition(camera_pos);
|
|
||||||
glm::mat4 view = glm::lookAt(GlobalCanvasSettings::getCameraPosition(),
|
|
||||||
glm::vec3(view_x, view_y, 0.0f),
|
glm::vec3(view_x, view_y, 0.0f),
|
||||||
glm::vec3(0.0f, 1.0f, 0.0f));
|
glm::vec3(0.0f, 1.0f, 0.0f));
|
||||||
|
|
||||||
@ -181,50 +130,47 @@ int main(int argc, char **argv)
|
|||||||
}
|
}
|
||||||
ImGui::End();
|
ImGui::End();
|
||||||
|
|
||||||
|
{
|
||||||
|
ImGui::Begin("Model Matrix");
|
||||||
|
glm::mat4 mat = m.getModelMatrix();
|
||||||
|
static float x_pos = 0.0f;
|
||||||
|
static float y_rot = 0.0f, z_rot =0.0f, x_rot = 0.0f;
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][0], mat[1][0], mat[2][0], mat[3][0]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][1], mat[1][1], mat[2][1], mat[3][1]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][2], mat[1][2], mat[2][2], mat[3][2]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][3], mat[1][3], mat[2][3], mat[3][3]);
|
||||||
|
ImGui::SliderFloat("X Pos", &x_pos, -5, 5);
|
||||||
|
ImGui::SliderFloat("X Rotation", &x_rot, -180.0f, 180.0f);
|
||||||
|
ImGui::SliderFloat("Y Rotation", &y_rot, -180.0f, 180.0f);
|
||||||
|
ImGui::SliderFloat("Z Rotation", &z_rot, -180.0f, 180.0f);
|
||||||
|
mat = glm::scale(glm::mat4(1.0f), glm::vec3(0.2f, 0.2f, 0.2f));
|
||||||
|
mat = glm::rotate(mat, glm::radians(x_rot), glm::vec3(1.0f, 0.0f, 0.0f));
|
||||||
|
mat = glm::rotate(mat, glm::radians(y_rot), glm::vec3(0.0f, 1.0f, 0.0f));
|
||||||
|
mat = glm::rotate(mat, glm::radians(z_rot), glm::vec3(0.0f, 0.0f, 1.0f));
|
||||||
|
mat = glm::translate(glm::mat4(1.0), glm::vec3(x_pos, 0.0f, 0.0f)) * mat;
|
||||||
|
m.setModelMatrix(mat);
|
||||||
|
ImGui::End();
|
||||||
|
}
|
||||||
|
{
|
||||||
|
ImGui::Begin("Normal Matrix");
|
||||||
|
glm::mat4 mat = m.getNormalMatrix();
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][0], mat[1][0], mat[2][0], mat[3][0]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][1], mat[1][1], mat[2][1], mat[3][1]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][2], mat[1][2], mat[2][2], mat[3][2]);
|
||||||
|
ImGui::Text("%.2f %.2f %.2f %.2f", mat[0][3], mat[1][3], mat[2][3], mat[3][3]);
|
||||||
|
ImGui::End();
|
||||||
|
}
|
||||||
|
|
||||||
|
m.render();
|
||||||
coords.render();
|
coords.render();
|
||||||
auto imu_rot_mat = imu_serial.get_rot_matrix();
|
|
||||||
|
|
||||||
auto imu_model_matrix = imu_base_mat * imu_correction_inverse * imu_rot_mat * imu_correction_matrix;
|
glm::mat4 current_model_matrix = m.getModelMatrix();
|
||||||
|
current_model_matrix = glm::translate(glm::mat4(1.0f), glm::vec3(3.0f, 0.0f, 0.0f)) * current_model_matrix;
|
||||||
|
m.setModelMatrix(current_model_matrix);
|
||||||
|
|
||||||
imu.setModelMatrix(imu_model_matrix);
|
glPolygonMode(GL_FRONT_AND_BACK, GL_LINE);
|
||||||
imu.render();
|
m.render();
|
||||||
|
glPolygonMode(GL_FRONT_AND_BACK, GL_FILL);
|
||||||
{
|
|
||||||
ImGui::Begin("IMU Attitude & Heading");
|
|
||||||
auto quat = imu_serial.get_quaternion();
|
|
||||||
auto euler = glm::eulerAngles(quat) * 180.0f / (float)M_PI;
|
|
||||||
ImGui::Text("Euler XYZ: %.0f | %.0f | %.0f", euler.x, euler.y, euler.z);
|
|
||||||
ImGui::Text("Quat WIJK: %.02f | %.02f | %.02f | %.02f", quat.w, quat.x, quat.y, quat.z);
|
|
||||||
ImGui::End();
|
|
||||||
}
|
|
||||||
|
|
||||||
{
|
|
||||||
auto accel = imu_serial.get_accel();
|
|
||||||
auto gyro = imu_serial.get_gyro();
|
|
||||||
auto current_rot_matrix = imu_serial.get_rot_matrix();
|
|
||||||
auto global_accel = current_rot_matrix * glm::vec4(accel, 0.0f);
|
|
||||||
auto global_gyr = current_rot_matrix * glm::vec4(gyro, 0.0f);
|
|
||||||
|
|
||||||
ImGui::Begin("IMU Data");
|
|
||||||
ImGui::Text("GYR X: %8.2f\t\t °/s", glm::degrees(gyro.x));
|
|
||||||
ImGui::Text("GYR Y: %8.2f\t\t °/s", glm::degrees(gyro.y));
|
|
||||||
ImGui::Text("GYR Z: %8.2f\t\t °/s", glm::degrees(gyro.z));
|
|
||||||
ImGui::Spacing();
|
|
||||||
ImGui::Text("GYR right: %8.2f\t\t °/s", glm::degrees(global_gyr.x));
|
|
||||||
ImGui::Text("GYR front: %8.2f\t\t °/s", glm::degrees(global_gyr.y));
|
|
||||||
ImGui::Text("GYR up: %8.2f\t\t °/s", glm::degrees(global_gyr.z));
|
|
||||||
ImGui::Separator();
|
|
||||||
ImGui::Text("ACC X: %8.3f\t\t g", accel.x);
|
|
||||||
ImGui::Text("ACC Y: %8.3f\t\t g", accel.y);
|
|
||||||
ImGui::Text("ACC Z: %8.3f\t\t g", accel.z);
|
|
||||||
ImGui::Spacing();
|
|
||||||
ImGui::Text("ACC right\t: %8.3f\t g", global_accel.x);
|
|
||||||
ImGui::Text("ACC front\t: %8.3f\t g", global_accel.y);
|
|
||||||
ImGui::Text("ACC up \t: %8.3f\t g", global_accel.z);
|
|
||||||
|
|
||||||
ImGui::End();
|
|
||||||
}
|
|
||||||
|
|
||||||
ImGui::Render();
|
ImGui::Render();
|
||||||
ImGui_ImplOpenGL3_RenderDrawData(ImGui::GetDrawData());
|
ImGui_ImplOpenGL3_RenderDrawData(ImGui::GetDrawData());
|
||||||
|
Loading…
Reference in New Issue
Block a user