Renesas GR-PEACH OpenCV Development
/
gr-peach-opencv-project-sd-card_update
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of
gr-peach-opencv-project-sd-card
by 
the do
graphicFramework/mGraphic.cpp
- Committer:
- thedo
- Date:
- 2017-07-21
- Revision:
- 166:240bc5a0f42a
File content as of revision 166:240bc5a0f42a:
#include "mGraphic.hpp"
int counter =0;
static void togle_led(DigitalOut led)
{
led = 1;
wait(0.1);
led = 0;
wait(0.1);
}
graphicFrameworkCanvas::graphicFrameworkCanvas(uint8_t * bufDraw, uint16_t w,uint16_t h,
int8_t bpp, int8_t drawPoint, int8_t sizeHeader)
{
mBufLcd = bufDraw;
mWidth = w;
mHeight = h;
mBpp = bpp;
mDrawPoint = drawPoint;
mSizeHeaderImg = sizeHeader;
}
graphicFrameworkCanvas::~graphicFrameworkCanvas()
{
}
void graphicFrameworkCanvas::draw_pixel(uint8_t * p_buf, int id, int x, int y)
{
int idx_base;
int wk_idx;
int i;
int j;
uint8_t coller_pix[mBpp]; /* ARGB4444 */
/* A coordinate in the upper left is calculated from a central coordinate. */
if ((x - (mDrawPoint / 2)) >= 0) {
x -= (mDrawPoint / 2);
}
if (x > (mWidth - mDrawPoint)) {
x = (mWidth - mDrawPoint);
}
if ((y - (mDrawPoint / 2)) >= 0) {
y -= (mDrawPoint / 2);
}
if (y > (mHeight - mDrawPoint)) {
y = (mHeight - mDrawPoint);
}
idx_base = (x + (mWidth * y)) * mBpp;
/* Select color */
if (id == 0) {
/* Blue */
coller_pix[0] = 0x4F; /* 4:Green 4:Blue */
coller_pix[1] = 0xF8; /* 4:Alpha 4:Red */
} else {
/* Pink */
coller_pix[0] = 0xFF; /* 4:Green 4:Blue */
coller_pix[1] = 0x0F; /* 4:Alpha 4:Red */
}
/* Drawing */
for (i = 0; i < mDrawPoint; i++) {
wk_idx = idx_base + (mWidth * mBpp * i);
for (j = 0; j < mDrawPoint; j++) {
p_buf[wk_idx++] = coller_pix[0];
p_buf[wk_idx++] = coller_pix[1];
}
}
}
void graphicFrameworkCanvas::draw_pixel(uint8_t * p_buf, int id,
int x, int y,uint8_t *color)
{
int idx_base;
int wk_idx;
int i;
int j;
/* A coordinate in the upper left is calculated from a central coordinate. */
if ((x - (mDrawPoint / 2)) >= 0) {
x -= (mDrawPoint / 2);
}
if (x > (mWidth - mDrawPoint)) {
x = (mWidth - mDrawPoint);
}
if ((y - (mDrawPoint / 2)) >= 0) {
y -= (mDrawPoint / 2);
}
if (y > (mHeight - mDrawPoint)) {
y = (mHeight - mDrawPoint);
}
idx_base = (x + (mWidth * y)) * mBpp;
/* Drawing */
for (i = 0; i < mDrawPoint; i++) {
wk_idx = idx_base + (mWidth * mBpp * i);
for (j = 0; j < mDrawPoint; j++) {
p_buf[wk_idx++] = color[0];
p_buf[wk_idx++] = color[1];
}
}
}
void graphicFrameworkCanvas::drawImage(uint8_t * _img, int _x, int _y)
{
uint8_t *p_buf = _img;
uint8_t coller_pix[mBpp];
uint16_t w = (_img[1] << 8) | _img[0];
uint16_t h = (_img[3] << 8) | _img[2];
uint8_t bpp = _img[4];
p_buf+=mSizeHeaderImg;
for(int i = 0;i < (int)h*w*bpp; i+=2)
{
int pos_x = (i/2)%w;
int pos_y = (i/2)/w;
coller_pix[0] = p_buf[i];
coller_pix[1] = p_buf[i+1];
draw_pixel(mBufLcd, 0, pos_x + _x, pos_y + _y,coller_pix);
}
}
void graphicFrameworkCanvas::drawRect(int x, int y, int width, int height,
uint8_t *color)
{
for(int k = 0; k < width;k++)
{
draw_pixel(mBufLcd, 0, x + k, y, color);
draw_pixel(mBufLcd, 0, x + k, y + height,color);
}
for(int k = 0; k < height;k++)
{
draw_pixel(mBufLcd, 0, x, y + k, color);
draw_pixel(mBufLcd, 0, x + width, y + k,color);
}
}
void graphicFrameworkCanvas::draw_pixel(int x, int y,uint8_t *color)
{
int idx_base;
int wk_idx;
int i;
int j;
/* A coordinate in the upper left is calculated from a central coordinate. */
if ((x - (mDrawPoint / 2)) >= 0) {
x -= (mDrawPoint / 2);
}
if (x > (mWidth - mDrawPoint)) {
x = (mWidth - mDrawPoint);
}
if ((y - (mDrawPoint / 2)) >= 0) {
y -= (mDrawPoint / 2);
}
if (y > (mHeight - mDrawPoint)) {
y = (mHeight - mDrawPoint);
}
idx_base = (x + (mWidth * y)) * mBpp;
/* Drawing */
for (i = 0; i < mDrawPoint; i++) {
wk_idx = idx_base + (mWidth * mBpp * i);
for (j = 0; j < mDrawPoint; j++) {
mBufLcd[wk_idx++] = color[0];
mBufLcd[wk_idx++] = color[1];
}
}
return;
}
void graphicFrameworkCanvas::drawLineNormal(int x1, int y1, int x2, int y2, uint8_t* color)
{
int tmp_x = 0;
int tmp_y = 0;
int i = 0;
if (x1 == x2) // Case equation x = m.
{
if (y1 > y2) // Swap 2 points
{
//ptTemp = pt1;
tmp_x = x1;
tmp_y = y1;
//pt1 = pt2;
x1 = x2;
y1 = y2;
//pt2 = ptTemp;
x2 = tmp_x;
y2 = tmp_y;
}
for (i = y1; i <= y2; i++) // Draw points
{
draw_pixel(x1,i,color);
}
return;
}
if (y1 == y2) // Case equation y = m.
{
if (x1 > x2) // Swap 2 points
{
//ptTemp = pt1;
tmp_x = x1;
tmp_y = y1;
//pt1 = pt2;
x1 = x2;
y1 = y2;
//pt2 = ptTemp;
x2 = tmp_x;
y2 = tmp_y;
}
for (i = x1; i <= x2; i++) // Draw points
{
draw_pixel(i,y1,color);
}
return;
}
// Case equation y = ax + b
float fA = (((float)(y2 - y1))) / (x2 - x1); // Calculate a.
float fB = y1 - fA * x1; // Calculate b.
if (x1 > x2) // Swap 2 points
{
//ptTemp = pt1;
tmp_x = x1;
tmp_y = y1;
//pt1 = pt2;
x1 = x2;
y1 = y2;
//pt2 = ptTemp;
x2 = tmp_x;
y2 = tmp_y;
}
// Calculate every points based on the equation
for (i = x1; i <= x2; i++)
{
draw_pixel(i,(int)floor(fA * i + fB),color);
}
}
void graphicFrameworkCanvas::drawBresenham1(int x1, int y1, int x2, int y2,
uint8_t* color)
{
int iDx = abs(x2 - x1);
int iDy = abs(y2 - y1);
int iTwoDy = 2 * iDy;
int iTwoDyMinusDx = 2 * (iDy - iDx);
int iP = iTwoDy - iDx;
int iX, iY, iXEnd;
// Get smaller x to base
if (x1 > x2)
{
iX = x2;
iY = y2;
iXEnd = x1;
}
else
{
iX = x1;
iY = y1;
iXEnd = x2;
}
// Draw first point
draw_pixel(iX,iY,color);
while (iX < iXEnd)
{
iX++;
if (iP < 0)
iP += iTwoDy;
else
{
iY++;
iP += iTwoDyMinusDx;
}
// Draw points
draw_pixel(iX,iY,color);
}
}
void graphicFrameworkCanvas::drawBresenham2(int x1, int y1, int x2, int y2, uint8_t* color)
{
int iDx = abs(x2 - x1);
int iDy = abs(y2 - y1);
int iTwoDy = 2 * iDy;
int iTwoDyMinusDx = 2 * (iDy - iDx);
int iP = -iTwoDy - iDx;
int iX, iY, iXEnd;
// Get smaller x to base
if (x1 > x2)
{
iX = x2;
iY = y2;
iXEnd = x1;
}
else
{
iX = x1;
iY = y1;
iXEnd = x2;
}
// Draw first point
draw_pixel(iX,iY,color);
while (iX < iXEnd)
{
iX++;
if (iP < 0)
iP += iTwoDy;
else
{
iY--;
iP += iTwoDyMinusDx;
}
// Draw points
draw_pixel(iX,iY,color);
}
}
void graphicFrameworkCanvas::drawBresenham3(int x1, int y1, int x2, int y2,
uint8_t* color)
{
int iDx = abs(x2 - x1);
int iDy = abs(y2 - y1);
int iTwoDx = 2 * iDx;
int iTwoDxMinusDy = 2 * (iDx - iDy);
int iP = iTwoDx - iDy;
int iX, iY, iYEnd;
// Get smaller x to base
if (y1 > y2)
{
iX = x2;
iY = y2;
iYEnd = y1;
}
else
{
iX = x1;
iY = y1;
iYEnd = y2;
}
// Draw first point
draw_pixel(iX,iY,color);
while (iY < iYEnd)
{
iY++;
if (iP < 0)
iP += iTwoDx;
else
{
iX++;
iP += iTwoDxMinusDy;
}
// Draw points
draw_pixel(iX,iY,color);
}
}
void graphicFrameworkCanvas::drawBresenham4(int x1, int y1, int x2, int y2,
uint8_t* color)
{
int iDx = abs(x2 - x1);
int iDy = abs(y2 - y1);
int iTwoDx = 2 * iDx;
int iTwoDxMinusDy = 2 * (iDx - iDy);
int iP = -iTwoDx - iDy;
int iX, iY, iYEnd;
// Get smaller x to base
if (y1 > y2)
{
iX = x1;
iY = y1;
iYEnd = y2;
}
else
{
iX = x2;
iY = y2;
iYEnd = y1;
}
// Draw first point
draw_pixel(iX,iY,color);
while (iY > iYEnd)
{
iY--;
if (iP < 0)
iP += iTwoDx;
else
{
iX++;
iP += iTwoDxMinusDy;
}
// Draw points
draw_pixel(iX,iY,color);
}
}
void graphicFrameworkCanvas::drawLine(int x1, int y1, int x2, int y2,
uint8_t* color)
{
if (x1 == x2 || y1 == y2) // Case equation x = m or y = m.
{
drawLineNormal(x1,y1,x2,y2,color);
return;
}
// Case equation y = ax + b
float fA = ((float)(y2 - y1)) / (x2 - x1); // Calculate a.
// Case (0 < m < 1).
if (fA > 0 && fA < 1)
{
drawBresenham1(x1,y1,x2,y2,color);
return;
}
// Case (-1 < m < 0).
if (fA > -1 && fA < 0)
{
drawBresenham2(x1,y1,x2,y2,color);
return;
}
// Case (m >= 1).
if (fA >= 1)
{
drawBresenham3(x1,y1,x2,y2,color);
return;
}
// Case (m =< -1).
if (fA <= -1)
{
drawBresenham4(x1,y1,x2,y2,color);
return;
}
}
void graphicFrameworkCanvas::drawCircle(int x0,int y0, int radius, uint8_t* color)
{
int x = radius;
int y = 0;
int err = 0;
while (x >= y)
{
// Draw points
draw_pixel(x0 + x,y0 + y,color);
draw_pixel(x0 + y, y0 + x,color);
draw_pixel(x0 - y, y0 + x,color);
draw_pixel(x0 - x, y0 + y,color);
draw_pixel(x0 - x, y0 - y,color);
draw_pixel(x0 - y, y0 - x,color);
draw_pixel(x0 + y, y0 - x,color);
draw_pixel(x0 + x, y0 - y,color);
y += 1;
if (err <= 0)
{
err += 2*y + 1;
} else
{
x -= 1;
err += 2 * (y - x) + 1;
}
}
}