[driver] Ili9241: Add drawRaw() method

Author: rleh

src/modm/driver/display/ili9341.hpp

@@ -251,6 +251,9 @@ class Ili9341 : public Interface, public modm::GraphicDisplay
 				 uint16_t width, uint16_t height,
 				 modm::accessor::Flash<uint8_t> data) override;
 
+	virtual void
+	drawRaw(glcd::Point upperLeft, uint16_t width, uint16_t height, glcd::Color* data);
+
 	void
 	setScrollArea(uint16_t topFixedRows, uint16_t bottomFixedRows, uint16_t firstRow);
 	void

src/modm/driver/display/ili9341_impl.hpp

@@ -202,11 +202,10 @@ void
 Ili9341<Interface, Reset, Backlight, BufferSize>::drawHorizontalLine(
 		glcd::Point start, uint16_t length)
 {
-	auto const fgColor { foregroundColor.getValue() };
+	uint16_t const pixelValue { modm::toBigEndian(foregroundColor.getValue()) };
 	auto minLength { std::min(std::size_t(length), BufferSize) };
 	uint16_t *buffer16 { reinterpret_cast<uint16_t *>(buffer) };
-	for (std::size_t i = 0; i < minLength; ++i)
-		buffer16[i] = modm::toBigEndian(fgColor);
+	std::fill(buffer16, buffer16+minLength, pixelValue);
 
 	BatchHandle h(*this);
 
@@ -224,11 +223,10 @@ void
 Ili9341<Interface, Reset, Backlight, BufferSize>::drawVerticalLine(
 		glcd::Point start, uint16_t length)
 {
-	auto const fgColor { foregroundColor.getValue() };
+	uint16_t const pixelValue { modm::toBigEndian(foregroundColor.getValue()) };
 	auto minLength { std::min(std::size_t(length), BufferSize) };
 	uint16_t *buffer16 { reinterpret_cast<uint16_t *>(buffer) };
-	for (std::size_t i = 0; i < minLength; ++i)
-		buffer16[i] = modm::toBigEndian(fgColor);
+	std::fill(buffer16, buffer16+minLength, pixelValue);
 
 	BatchHandle h(*this);
 
@@ -250,11 +248,10 @@ Ili9341<Interface, Reset, Backlight, BufferSize>::fillRectangle(
 	auto const y { upperLeft.getY() };
 	std::size_t pixelCount { std::size_t(width) * std::size_t(height) };
 
-	auto const fgColor { foregroundColor.getValue() };
+	uint16_t const pixelValue { modm::toBigEndian(foregroundColor.getValue()) };
 	auto minLength { std::min(std::size_t(pixelCount), BufferSize) };
 	uint16_t *buffer16 { reinterpret_cast<uint16_t *>(buffer) };
-	for (std::size_t i = 0; i < minLength; ++i)
-		buffer16[i] = modm::toBigEndian(fgColor);
+	std::fill(buffer16, buffer16+minLength, pixelValue);
 
 	BatchHandle h(*this);
 
@@ -350,6 +347,22 @@ Ili9341<Interface, Reset, Backlight, BufferSize>::drawImageRaw(glcd::Point upper
 	}
 }
 
+template <class Interface, class Reset, class Backlight, std::size_t BufferSize>
+void
+Ili9341<Interface, Reset, Backlight, BufferSize>::drawRaw(glcd::Point upperLeft,
+		uint16_t width, uint16_t height, glcd::Color* data)
+{
+	BatchHandle h(*this);
+
+	uint16_t* buffer = (uint16_t*)data;
+	for(size_t i = 0; i < size_t(width*height); i++) {
+		buffer[i] = modm::fromBigEndian(buffer[i]);
+	}
+
+	setClipping(upperLeft.getX(), upperLeft.getY(), width, height);
+	this->writeData((uint8_t*)buffer, width * height * 2);
+}
+
 template <class Interface, class Reset, class Backlight, std::size_t BufferSize>
 void
 Ili9341<Interface, Reset, Backlight, BufferSize>::setScrollArea(