Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Wire.h>
- #include <SPI.h>
- #include "ADXL345.h" // Biblioteka do obsługi ADXL345
- #include "LCD.h" // Biblioteka do obsługi wyświetlacza LCD
- #include "DEV_Config.h" // Konfiguracja sprzętowa wyświetlacza
- // Definicje stałych
- #define DISPLAY_WIDTH 160
- #define DISPLAY_HEIGHT 128
- #define BALL_RADIUS 5
- #define CENTER_X (DISPLAY_WIDTH / 2)
- #define CENTER_Y (DISPLAY_HEIGHT / 2)
- #define SENSITIVITY 2 // Czynnik wrażliwości (dostosuj, jeśli ruch kulki jest za szybki lub wolny)
- // Definicje kolorów (dostosuj do swojej biblioteki)
- #define BLACK 0x0000
- #define WHITE 0xFFFF
- #define RED 0xF800
- #define GREEN 0x07E0
- #define YELLOW 0xFFE0
- ADXL345 accelerometer;
- void setup() {
- // Inicjalizacja komunikacji
- Serial.begin(9600);
- Wire.begin();
- SPI.begin();
- // Inicjalizacja akcelerometru ADXL345
- accelerometer = ADXL345();
- accelerometer.begin();
- accelerometer.setRange(ADXL345_RANGE_4G);
- // Inicjalizacja wyświetlacza LCD
- System_Init();
- LCD_Init(SCAN_DIR_DFT);
- LCD_Clear(BLACK);
- LCD_Show();
- }
- void loop() {
- // Odczyt przyspieszeń – wartości znormalizowane (w jednostkach g)
- Vector accNorm = accelerometer.readNormalize();
- float ax = accNorm.XAxis;
- float ay = accNorm.YAxis;
- float az = accNorm.ZAxis;
- // Obliczanie kątów (w stopniach)
- // Używamy funkcji arctan dla pitch i roll
- float pitch = atan(ax / sqrt(ay * ay + az * az)) * (180.0 / PI);
- float roll = atan(ay / sqrt(ax * ax + az * az)) * (180.0 / PI);
- // Mapowanie wartości kątowych na przesunięcie kulki względem środka ekranu:
- // Przyjmujemy, że:
- // - Pochylenie do przodu (dodatni pitch) przesuwa kulkę w dół (większe współrzędne Y)
- // - Pochylenie w bok (roll) przesuwa kulkę w lewo/prawo.
- int ballX = CENTER_X + (int)(roll * SENSITIVITY);
- int ballY = CENTER_Y + (int)(pitch * SENSITIVITY);
- // Sprawdzenie, czy kulka nie wychodzi poza obszar wyświetlacza.
- // Jeśli dotyka krawędzi, ustawiamy flagę edge na true.
- bool edge = false;
- if (ballX < BALL_RADIUS) {
- ballX = BALL_RADIUS;
- edge = true;
- }
- if (ballX > DISPLAY_WIDTH - BALL_RADIUS) {
- ballX = DISPLAY_WIDTH - BALL_RADIUS;
- edge = true;
- }
- if (ballY < BALL_RADIUS) {
- ballY = BALL_RADIUS;
- edge = true;
- }
- if (ballY > DISPLAY_HEIGHT - BALL_RADIUS) {
- ballY = DISPLAY_HEIGHT - BALL_RADIUS;
- edge = true;
- }
- // Ustalenie koloru kulki:
- // Jeśli kulka dotknęła krawędzi, kolor czerwony; w przeciwnym przypadku zielony.
- uint16_t ballColor = edge ? RED : GREEN;
- // Czyścimy ekran przed rysowaniem (możesz zmodyfikować, aby odświeżać tylko część ekranu)
- LCD_Clear(BLACK);
- // Rysowanie kulki na ekranie
- LCD_FillCircle(ballX, ballY, BALL_RADIUS, ballColor);
- // Jeśli kulka dotyka krawędzi, wyświetlamy komunikat
- if(edge) {
- LCD_DisplayString(0, DISPLAY_HEIGHT - 15, "Krawedz!", &Font12, BLACK, WHITE);
- }
- // Opcjonalnie: wyświetlenie wartości pitch i roll na górze ekranu
- char buf[32];
- sprintf(buf, "Pitch: %.1f", pitch);
- LCD_DisplayString(0, 0, buf, &Font12, BLACK, YELLOW);
- sprintf(buf, "Roll : %.1f", roll);
- LCD_DisplayString(0, 15, buf, &Font12, BLACK, YELLOW);
- delay(100);
- }
Advertisement
Add Comment
Please, Sign In to add comment