kopia lustrzana https://github.com/pimoroni/pimoroni-pico
106 wiersze
2.7 KiB
C++
106 wiersze
2.7 KiB
C++
#include "pico/stdlib.h"
|
|
#include <stdio.h>
|
|
#include <math.h>
|
|
#include <sstream>
|
|
#include <iomanip>
|
|
|
|
#include "common/pimoroni_i2c.hpp"
|
|
#include "pico_explorer.hpp"
|
|
#include "breakout_potentiometer.hpp"
|
|
#include "drivers/st7789/st7789.hpp"
|
|
#include "libraries/pico_graphics/pico_graphics.hpp"
|
|
|
|
using namespace pimoroni;
|
|
|
|
ST7789 st7789(PicoExplorer::WIDTH, PicoExplorer::HEIGHT, ROTATE_0, false, get_spi_pins(BG_SPI_FRONT));
|
|
PicoGraphics_PenRGB332 graphics(st7789.width, st7789.height, nullptr);
|
|
|
|
Pen BLACK = graphics.create_pen(0, 0, 0);
|
|
Pen RED = graphics.create_pen(255, 0, 0);
|
|
Pen GREEN = graphics.create_pen(0, 255, 0);
|
|
Pen BLUE = graphics.create_pen(0, 0, 255);
|
|
|
|
I2C i2c(PICO_EXPLORER);
|
|
BreakoutPotentiometer pot(&i2c);
|
|
bool toggle = false;
|
|
|
|
int main() {
|
|
#ifdef PICO_DEFAULT_LED_PIN
|
|
gpio_init(PICO_DEFAULT_LED_PIN);
|
|
gpio_set_dir(PICO_DEFAULT_LED_PIN, GPIO_OUT);
|
|
#endif
|
|
|
|
stdio_init_all();
|
|
|
|
printf("Starting...\n");
|
|
|
|
if(pot.init()) {
|
|
printf("Potentiometer found...\n");
|
|
|
|
while(true) {
|
|
#ifdef PICO_DEFAULT_LED_PIN
|
|
gpio_put(PICO_DEFAULT_LED_PIN, toggle);
|
|
#endif
|
|
toggle = !toggle;
|
|
|
|
float percent = pot.read();
|
|
|
|
printf("Percent: %d\n", (int)(percent * 100));
|
|
RGB p = RGB::from_hsv(percent, 1.0f, 1.0f);
|
|
pot.set_led(p.r, p.g, p.b);
|
|
|
|
graphics.set_pen(BLACK);
|
|
graphics.clear();
|
|
|
|
{
|
|
graphics.set_pen(RED);
|
|
std::ostringstream ss;
|
|
ss << "R = ";
|
|
ss << (int)(p.r);
|
|
std::string s(ss.str());
|
|
graphics.text(s, Point(10, 10), 220, 6);
|
|
}
|
|
|
|
{
|
|
graphics.set_pen(GREEN);
|
|
std::ostringstream ss;
|
|
ss << "G = ";
|
|
ss << (int)(p.g);
|
|
std::string s(ss.str());
|
|
graphics.text(s, Point(10, 70), 220, 6);
|
|
}
|
|
|
|
{
|
|
graphics.set_pen(BLUE);
|
|
std::ostringstream ss;
|
|
ss << "B = ";
|
|
ss << (int)(p.b);
|
|
std::string s(ss.str());
|
|
graphics.text(s, Point(10, 130), 220, 6);
|
|
}
|
|
|
|
{
|
|
// Shouldn't really use create_pen in-line.
|
|
// In default (RGB332) palette mode this will lookup the nearest 8-bit colour
|
|
graphics.set_pen(graphics.create_pen(p.r, p.g, p.b));
|
|
std::ostringstream ss;
|
|
ss << "#";
|
|
ss << std::uppercase << std::hex << std::setfill('0') << std::setw(2) << (int)(p.r);
|
|
ss << std::uppercase << std::hex << std::setfill('0') << std::setw(2) << (int)(p.g);
|
|
ss << std::uppercase << std::hex << std::setfill('0') << std::setw(2) << (int)(p.b);
|
|
std::string s(ss.str());
|
|
graphics.text(s, Point(10, 190), 220, 5);
|
|
}
|
|
st7789.update(&graphics);
|
|
}
|
|
}
|
|
else {
|
|
printf("No Potentiometer found :'(\n");
|
|
#ifdef PICO_DEFAULT_LED_PIN
|
|
gpio_put(PICO_DEFAULT_LED_PIN, true);
|
|
#endif
|
|
}
|
|
|
|
return 0;
|
|
}
|