consolidate all repos to one for archive
This commit is contained in:
@@ -0,0 +1,16 @@
|
||||
#pragma once
|
||||
#include <cstdint>
|
||||
|
||||
class serial
|
||||
{
|
||||
public:
|
||||
serial();
|
||||
~serial();
|
||||
bool init(const char *path);
|
||||
int swrite(uint8_t *data, int size);
|
||||
int sread(uint8_t *data, int size);
|
||||
int sioctl();
|
||||
|
||||
private:
|
||||
int serial_port = 0;
|
||||
};
|
@@ -0,0 +1,28 @@
|
||||
#include "serial.h"
|
||||
#include <string>
|
||||
#include <iostream>
|
||||
#include <string.h>
|
||||
#include <chrono>
|
||||
|
||||
int main()
|
||||
{
|
||||
serial s;
|
||||
if (!s.init("/dev/ttyACM0"))
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
|
||||
int16_t buf[50];
|
||||
s.sread((uint8_t *)buf, sizeof(buf));
|
||||
while (true)
|
||||
{
|
||||
s.sread((uint8_t *)buf, sizeof(buf));
|
||||
|
||||
if ('{' == *(char *)&buf[0])
|
||||
printf("%s\n", (char *)&buf[0]);
|
||||
else
|
||||
printf("%x %6d %6d %6d %6d %6d\n", (uint16_t)buf[0], (uint16_t)buf[1], buf[2], buf[3], buf[4], buf[5]);
|
||||
}
|
||||
|
||||
return 0; // success
|
||||
};
|
@@ -0,0 +1,77 @@
|
||||
import serial
|
||||
import struct
|
||||
import json
|
||||
import matplotlib.pyplot as plt
|
||||
|
||||
# Open the serial port
|
||||
ser = serial.Serial('/dev/ttyACM0', 48000)
|
||||
|
||||
if ser.is_open:
|
||||
print("Serial port is open")
|
||||
|
||||
plt.ion();
|
||||
fig, ax = plt.subplots(2);
|
||||
x_data_a, y_data_a, z_data_a = [], [], []
|
||||
x_data_b, y_data_b, z_data_b = [], [], []
|
||||
|
||||
ax[0].set_xlabel('Time');
|
||||
ax[0].set_ylabel('X,Y and Z values in ASCII');
|
||||
|
||||
ax[1].set_xlabel('Time');
|
||||
ax[1].set_ylabel('X,Y and Z values in raw binary data');
|
||||
running = True
|
||||
|
||||
try:
|
||||
while running:
|
||||
first_byte = ser.read(1)
|
||||
|
||||
if first_byte == b'{':
|
||||
remaining_data = ser.read_until(b'\n\r')
|
||||
full_data = first_byte + remaining_data
|
||||
|
||||
ascii_data = json.loads(full_data.decode('utf-8'))
|
||||
print(f"ASCII Data: {ascii_data}")
|
||||
|
||||
x_data_a.append(ascii_data['X']);
|
||||
y_data_a.append(ascii_data['Y']);
|
||||
z_data_a.append(ascii_data['Z']);
|
||||
|
||||
ax[0].clear();
|
||||
ax[0].plot(x_data_a, label='X')
|
||||
ax[0].plot(y_data_a, label='Y')
|
||||
ax[0].plot(z_data_a, label='Z')
|
||||
ax[0].legend()
|
||||
plt.draw()
|
||||
plt.pause(0.01)
|
||||
else:
|
||||
|
||||
# Read a packet of size equal to GyroPacket
|
||||
remaining_data = ser.read(11) # Assuming GyroPacket is 12 bytes long
|
||||
|
||||
full_data = first_byte + remaining_data
|
||||
|
||||
# Unpack the packet using struct
|
||||
packet = struct.unpack('<hhhhhh', full_data)
|
||||
|
||||
x_data_b.append(packet[2])
|
||||
y_data_b.append(packet[3])
|
||||
z_data_b.append(packet[4])
|
||||
|
||||
ax[1].clear()
|
||||
ax[1].plot(x_data_b, label='X')
|
||||
ax[1].plot(y_data_b, label='Y')
|
||||
ax[1].plot(z_data_b, label='Z')
|
||||
ax[1].legend()
|
||||
plt.draw()
|
||||
plt.pause(0.01)
|
||||
|
||||
# Print the unpacked data
|
||||
print(f"Header: {packet[0]:04X}, Packet Number: {packet[1]}, "
|
||||
f"X: {packet[2]}, Y: {packet[3]}, Z: {packet[4]}, "
|
||||
f"Temperature: {packet[5]}")
|
||||
|
||||
except KeyboardInterrupt:
|
||||
# Close the serial port when interrupted
|
||||
running = False
|
||||
ser.close()
|
||||
print("Serial port closed.")
|
@@ -0,0 +1,30 @@
|
||||
CC=g++
|
||||
|
||||
CFLAGS= -std=c++23
|
||||
|
||||
INCLUDE_DIR= include
|
||||
|
||||
SRC_DIR= src
|
||||
|
||||
# Get all cpp files from src directory
|
||||
SRCS := $(wildcard $(SRC_DIR)/*.cpp)
|
||||
|
||||
all: main
|
||||
|
||||
main: main.cpp $(SRCS)
|
||||
$(CC) $(CFLAGS) -O3 -I$(INCLUDE_DIR) $(SRCS) main.cpp -o main
|
||||
|
||||
debug: main.cpp $(SRCS)
|
||||
$(CC) $(CFLAGS) -I$(INCLUDE_DIR) $(SRCS) -g main.cpp -o main
|
||||
|
||||
run: main
|
||||
./main
|
||||
|
||||
print:
|
||||
ls /dev/ttyA*
|
||||
|
||||
zip:
|
||||
zip -r main.zip main.cpp $(INCLUDE_DIR) $(SRC_DIR) makefile
|
||||
|
||||
clean:
|
||||
rm main
|
@@ -0,0 +1,97 @@
|
||||
#include "serial.h"
|
||||
|
||||
// C library headers
|
||||
#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 <sys/ioctl.h>
|
||||
|
||||
serial::serial()
|
||||
{
|
||||
}
|
||||
|
||||
serial::~serial()
|
||||
{
|
||||
close(serial_port);
|
||||
}
|
||||
|
||||
bool serial::init(const char *path)
|
||||
{
|
||||
// Open the serial port. Change device path as needed (currently set to an standard FTDI USB-UART cable type device)
|
||||
serial_port = open(path, O_RDWR);
|
||||
|
||||
if (serial_port < 0)
|
||||
{
|
||||
printf("Error %i from open: %s\n", errno, strerror(errno));
|
||||
return false;
|
||||
}
|
||||
// Create new termios struct, we call it 'tty' for convention
|
||||
struct termios tty;
|
||||
|
||||
// Read in existing settings, and handle any error
|
||||
if (tcgetattr(serial_port, &tty) != 0)
|
||||
{
|
||||
printf("Error %i from tcgetattr: %s\n", errno, strerror(errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
tty.c_cflag &= ~PARENB; // Clear parity bit, disabling parity (most common)
|
||||
tty.c_cflag &= ~CSTOPB; // Clear stop field, only one stop bit used in communication (most common)
|
||||
tty.c_cflag &= ~CSIZE; // Clear all bits that set the data size
|
||||
tty.c_cflag |= CS8; // 8 bits per byte (most common)
|
||||
tty.c_cflag &= ~CRTSCTS; // Disable RTS/CTS hardware flow control (most common)
|
||||
tty.c_cflag |= CREAD | CLOCAL; // Turn on READ & ignore ctrl lines (CLOCAL = 1)
|
||||
|
||||
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_iflag &= ~(IXON | IXOFF | IXANY); // Turn off s/w flow ctrl
|
||||
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_oflag &= ~OXTABS; // Prevent conversion of tabs to spaces (NOT PRESENT ON LINUX)
|
||||
// tty.c_oflag &= ~ONOEOT; // Prevent removal of C-d chars (0x004) in output (NOT PRESENT ON LINUX)
|
||||
|
||||
tty.c_cc[VTIME] = 10; // Wait for up to 1s (10 deciseconds), returning as soon as any data is received.
|
||||
tty.c_cc[VMIN] = 0;
|
||||
|
||||
// Set in/out baud rate to be 9600
|
||||
cfsetispeed(&tty, 48000);
|
||||
cfsetospeed(&tty, 48000);
|
||||
|
||||
// Save tty settings, also checking for error
|
||||
if (tcsetattr(serial_port, TCSANOW, &tty) != 0)
|
||||
{
|
||||
printf("Error %i from tcsetattr: %s\n", errno, strerror(errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
// Here we assume we received ASCII data, but you might be sending raw bytes (in that case, don't try and
|
||||
// print it to the screen like this!)
|
||||
}
|
||||
|
||||
int serial::swrite(uint8_t *data, int size)
|
||||
{
|
||||
return write(serial_port, data, size);
|
||||
}
|
||||
|
||||
int serial::sread(uint8_t *data, int size)
|
||||
{
|
||||
return read(serial_port, data, size);
|
||||
}
|
||||
|
||||
int serial::sioctl()
|
||||
{
|
||||
int bytes;
|
||||
ioctl(serial_port, FIONREAD, &bytes);
|
||||
return bytes;
|
||||
}
|
Reference in New Issue
Block a user