pierdziadek

lab7+

Apr 13th, 2025
68
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 3.28 KB | None | 0 0
  1. #include <Wire.h>
  2. #include <SPI.h>
  3. #include "ADXL345.h" // Biblioteka do obsługi ADXL345
  4. #include "LCD.h" // Biblioteka do obsługi wyświetlacza LCD
  5. #include "DEV_Config.h" // Konfiguracja sprzętowa wyświetlacza
  6.  
  7. // Definicje stałych
  8. #define DISPLAY_WIDTH 160
  9. #define DISPLAY_HEIGHT 128
  10. #define BALL_RADIUS 5
  11. #define CENTER_X (DISPLAY_WIDTH / 2)
  12. #define CENTER_Y (DISPLAY_HEIGHT / 2)
  13. #define SENSITIVITY 2 // Czynnik wrażliwości (dostosuj, jeśli ruch kulki jest za szybki lub wolny)
  14.  
  15. // Definicje kolorów (dostosuj do swojej biblioteki)
  16. #define BLACK 0x0000
  17. #define WHITE 0xFFFF
  18. #define RED 0xF800
  19. #define GREEN 0x07E0
  20. #define YELLOW 0xFFE0
  21.  
  22. ADXL345 accelerometer;
  23.  
  24. void setup() {
  25. // Inicjalizacja komunikacji
  26. Serial.begin(9600);
  27. Wire.begin();
  28. SPI.begin();
  29.  
  30. // Inicjalizacja akcelerometru ADXL345
  31. accelerometer = ADXL345();
  32. accelerometer.begin();
  33. accelerometer.setRange(ADXL345_RANGE_4G);
  34.  
  35. // Inicjalizacja wyświetlacza LCD
  36. System_Init();
  37. LCD_Init(SCAN_DIR_DFT);
  38. LCD_Clear(BLACK);
  39. LCD_Show();
  40. }
  41.  
  42. void loop() {
  43. // Odczyt przyspieszeń – wartości znormalizowane (w jednostkach g)
  44. Vector accNorm = accelerometer.readNormalize();
  45. float ax = accNorm.XAxis;
  46. float ay = accNorm.YAxis;
  47. float az = accNorm.ZAxis;
  48.  
  49. // Obliczanie kątów (w stopniach)
  50. // Używamy funkcji arctan dla pitch i roll
  51. float pitch = atan(ax / sqrt(ay * ay + az * az)) * (180.0 / PI);
  52. float roll = atan(ay / sqrt(ax * ax + az * az)) * (180.0 / PI);
  53.  
  54. // Mapowanie wartości kątowych na przesunięcie kulki względem środka ekranu:
  55. // Przyjmujemy, że:
  56. // - Pochylenie do przodu (dodatni pitch) przesuwa kulkę w dół (większe współrzędne Y)
  57. // - Pochylenie w bok (roll) przesuwa kulkę w lewo/prawo.
  58. int ballX = CENTER_X + (int)(roll * SENSITIVITY);
  59. int ballY = CENTER_Y + (int)(pitch * SENSITIVITY);
  60.  
  61. // Sprawdzenie, czy kulka nie wychodzi poza obszar wyświetlacza.
  62. // Jeśli dotyka krawędzi, ustawiamy flagę edge na true.
  63. bool edge = false;
  64. if (ballX < BALL_RADIUS) {
  65. ballX = BALL_RADIUS;
  66. edge = true;
  67. }
  68. if (ballX > DISPLAY_WIDTH - BALL_RADIUS) {
  69. ballX = DISPLAY_WIDTH - BALL_RADIUS;
  70. edge = true;
  71. }
  72. if (ballY < BALL_RADIUS) {
  73. ballY = BALL_RADIUS;
  74. edge = true;
  75. }
  76. if (ballY > DISPLAY_HEIGHT - BALL_RADIUS) {
  77. ballY = DISPLAY_HEIGHT - BALL_RADIUS;
  78. edge = true;
  79. }
  80.  
  81. // Ustalenie koloru kulki:
  82. // Jeśli kulka dotknęła krawędzi, kolor czerwony; w przeciwnym przypadku zielony.
  83. uint16_t ballColor = edge ? RED : GREEN;
  84.  
  85. // Czyścimy ekran przed rysowaniem (możesz zmodyfikować, aby odświeżać tylko część ekranu)
  86. LCD_Clear(BLACK);
  87.  
  88. // Rysowanie kulki na ekranie
  89. LCD_FillCircle(ballX, ballY, BALL_RADIUS, ballColor);
  90.  
  91. // Jeśli kulka dotyka krawędzi, wyświetlamy komunikat
  92. if(edge) {
  93. LCD_DisplayString(0, DISPLAY_HEIGHT - 15, "Krawedz!", &Font12, BLACK, WHITE);
  94. }
  95.  
  96. // Opcjonalnie: wyświetlenie wartości pitch i roll na górze ekranu
  97. char buf[32];
  98. sprintf(buf, "Pitch: %.1f", pitch);
  99. LCD_DisplayString(0, 0, buf, &Font12, BLACK, YELLOW);
  100. sprintf(buf, "Roll : %.1f", roll);
  101. LCD_DisplayString(0, 15, buf, &Font12, BLACK, YELLOW);
  102.  
  103. delay(100);
  104. }
  105.  
Advertisement
Add Comment
Please, Sign In to add comment