mirror of
https://github.com/clockworkpi/PicoCalc.git
synced 2025-12-12 10:18:54 +01:00
533 lines
23 KiB
C
533 lines
23 KiB
C
/***********************************************************************************************************************
|
|
PicoMite MMBasic
|
|
|
|
SPI-LCD.c
|
|
|
|
<COPYRIGHT HOLDERS> Geoff Graham, Peter Mather
|
|
Copyright (c) 2021, <COPYRIGHT HOLDERS> All rights reserved.
|
|
Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
|
|
1. Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
|
|
2. Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer
|
|
in the documentation and/or other materials provided with the distribution.
|
|
3. The name MMBasic be used when referring to the interpreter in any documentation and promotional material and the original copyright message be displayed
|
|
on the console at startup (additional copyright messages may be added).
|
|
4. All advertising materials mentioning features or use of this software must display the following acknowledgement: This product includes software developed
|
|
by the <copyright holder>.
|
|
5. Neither the name of the <copyright holder> nor the names of its contributors may be used to endorse or promote products derived from this software
|
|
without specific prior written permission.
|
|
THIS SOFTWARE IS PROVIDED BY <COPYRIGHT HOLDERS> AS IS AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDERS> BE LIABLE FOR ANY DIRECT,
|
|
INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
|
OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
************************************************************************************************************************/
|
|
|
|
#include <stdarg.h>
|
|
#include "MMBasic_Includes.h"
|
|
#include "Hardware_Includes.h"
|
|
|
|
const uint32_t maskSPI111[32]={0x00000001,0x00000003,0x00000007,0x0000000f,0x0000001f,0x0000003f,0x0000007f,0x000000ff,
|
|
0x000001ff,0x000003ff,0x000007ff,0x00000fff,0x00001fff,0x00003fff,0x00007fff,0x0000ffff,
|
|
0x0001ffff,0x0003ffff,0x0007ffff,0x000fffff,0x001fffff,0x003fffff,0x007fffff,0x00ffffff,
|
|
0x01ffffff,0x03ffffff,0x07ffffff,0x0fffffff,0x1fffffff,0x3fffffff,0x7fffffff,0xffffffff};
|
|
const uint32_t rmaskSPI111[32]={0x80000000,0xC0000000,0xe0000000,0xf0000000,0xf8000000,0xfc000000,0xfe000000,0xff000000,
|
|
0xff800000,0xffC00000,0xffe00000,0xfff00000,0xfff80000,0xfffc0000,0xfffe0000,0xffff0000,
|
|
0xffff8000,0xffffC000,0xffffe000,0xfffff000,0xfffff800,0xfffffc00,0xfffffe00,0xffffff00,
|
|
0xffffff80,0xffffffC0,0xffffffe0,0xfffffff0,0xfffffff8,0xfffffffc,0xfffffffe,0xffffffff};
|
|
|
|
|
|
uint32_t *VideoBufRed = NULL; // Image buffer for red
|
|
uint32_t *VideoBufGrn = NULL; // Image buffer for green
|
|
uint32_t *VideoBufBlu = NULL; // Image buffer for blue
|
|
volatile int lcnt;
|
|
volatile int VCount; // counter for the number of lines in a frame
|
|
volatile int VState; // the state of the state machine
|
|
volatile int showbuffer = 0; // the next counter table (initialise in initVideo() below)
|
|
void SPI111hline(int x0, int x1, int y, int con, int which);
|
|
inline void plot(int x, int y, int con) ;
|
|
|
|
void SPI111init(void){
|
|
// if(Option.DISPLAY_TYPE !=SPI111) return;
|
|
DrawRectangle = DrawRectangleSPI111;
|
|
DrawBitmap = DrawBitmapSPI111;
|
|
ScrollLCD = ScrollSPI111;
|
|
DrawBuffer=DrawBufferSPI111;
|
|
ReadBuffer=ReadBufferSPI111;
|
|
}
|
|
void DrawRectangleSPI111(int x1, int y1, int x2, int y2, int c){
|
|
int i, t;
|
|
int col=0;
|
|
if(c & 0xFF0000)col =1;
|
|
if(c & 0xFF00)col +=2;
|
|
if(c & 0xFF)col +=4;
|
|
// make sure the coordinates are kept within the display area
|
|
if(x2 <= x1) { t = x1; x1 = x2; x2 = t; }
|
|
if(y2 <= y1) { t = y1; y1 = y2; y2 = t; }
|
|
if(x1 < 0) x1 = 0;
|
|
if(x1 >= HRes) x1 = HRes - 1;
|
|
if(x2 < 0) x2 = 0;
|
|
if(x2 >= HRes) x2 = HRes - 1;
|
|
if(y1 < 0) y1 = 0;
|
|
if(y1 >= VRes) y1 = VRes - 1;
|
|
if(y2 < 0) y2 = 0;
|
|
if(y2 >= VRes) y2 = VRes - 1;
|
|
for(i=y1;i<=y2;i++){
|
|
SPI111hline(x1,x2,i,col,0);
|
|
}
|
|
|
|
}
|
|
|
|
void DrawBitmapSPI111(int x1, int y1, int width, int height, int scale, int fc, int bc, unsigned char *bitmap){
|
|
int i, j, k, m;
|
|
unsigned char fcol,bcol;
|
|
int vertCoord, horizCoord, XStart, XEnd, YEnd;
|
|
|
|
// adjust when part of the bitmap is outside the displayable coordinates
|
|
vertCoord = y1; if(y1 < 0) y1 = 0; // the y coord is above the top of the screen
|
|
XStart = x1; if(XStart < 0) XStart = 0; // the x coord is to the left of the left marginn
|
|
XEnd = x1 + (width * scale) - 1; if(XEnd >= HRes) XEnd = HRes - 1; // the width of the bitmap will extend beyond the right margin
|
|
YEnd = y1 + (height * scale) - 1; if(YEnd >= VRes) YEnd = VRes - 1;// the height of the bitmap will extend beyond the bottom margin
|
|
fcol=0; bcol=0;
|
|
if(fc & 0xFF0000)fcol =1;
|
|
if(fc & 0xFF00)fcol +=2;
|
|
if(fc & 0xFF)fcol +=4;
|
|
if(bc!=-1){
|
|
if(bc & 0xFF0000)bcol =1;
|
|
if(bc & 0xFF00)bcol +=2;
|
|
if(bc & 0xFF)bcol +=4;
|
|
} else bcol=0xff;
|
|
|
|
for(i = 0; i < height; i++) { // step thru the font scan line by line
|
|
for(j = 0; j < scale; j++) { // repeat lines to scale the font
|
|
if(vertCoord++ < 0) continue; // we are above the top of the screen
|
|
if(vertCoord > VRes) return; // we have extended beyond the bottom of the screen
|
|
horizCoord = x1;
|
|
for(k = 0; k < width; k++) { // step through each bit in a scan line
|
|
for(m = 0; m < scale; m++) { // repeat pixels to scale in the x axis
|
|
if(horizCoord++ < 0) continue; // we have not reached the left margin
|
|
if(horizCoord > HRes) continue; // we are beyond the right margin
|
|
if((bitmap[((i * width) + k)/8] >> (((height * width) - ((i * width) + k) - 1) %8)) & 1) {
|
|
plot(horizCoord-1,vertCoord-1,fcol);
|
|
} else {
|
|
if(bcol!=0xff)plot(horizCoord-1,vertCoord-1,bcol);
|
|
}
|
|
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
void SPI111hline(int x0, int x1, int y, int con, int which) { //draw a horizontal line
|
|
uint32_t w1, xx1, w0, xx0, x, xn, i;
|
|
const uint32_t a[]={0xFFFFFFFF,0x7FFFFFFF,0x3FFFFFFF,0x1FFFFFFF,0xFFFFFFF,0x7FFFFFF,0x3FFFFFF,0x1FFFFFF,
|
|
0xFFFFFF,0x7FFFFF,0x3FFFFF,0x1FFFFF,0xFFFFF,0x7FFFF,0x3FFFF,0x1FFFF,
|
|
0xFFFF,0x7FFF,0x3FFF,0x1FFF,0xFFF,0x7FF,0x3FF,0x1FF,
|
|
0xFF,0x7F,0x3F,0x1F,0x0F,0x07,0x03,0x01};
|
|
const uint32_t b[]={0x80000000,0xC0000000,0xe0000000,0xf0000000,0xf8000000,0xfc000000,0xfe000000,0xff000000,
|
|
0xff800000,0xffC00000,0xffe00000,0xfff00000,0xfff80000,0xfffc0000,0xfffe0000,0xffff0000,
|
|
0xffff8000,0xffffC000,0xffffe000,0xfffff000,0xfffff800,0xfffffc00,0xfffffe00,0xffffff00,
|
|
0xffffff80,0xffffffC0,0xffffffe0,0xfffffff0,0xfffffff8,0xfffffffc,0xfffffffe,0xffffffff};
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed;
|
|
bg=VideoBufGrn;
|
|
bb=VideoBufBlu;
|
|
|
|
w0 = y * (SPIints_per_line) + x0/32;
|
|
xx0 = (x0 & 0x1F);
|
|
w1 = y * (SPIints_per_line) + x1/32;
|
|
xx1 = (x1 & 0x1F);
|
|
if(w1==w0){ //special case both inside same word
|
|
x=(a[xx0] & b[xx1]);
|
|
xn=~x;
|
|
if(con & 1) br[w0] |= x; else br[w0] &= xn; // turn on the red pixel
|
|
if(con & 2) bg[w0] |= x; else bg[w0] &= xn; // turn on the green pixel
|
|
if(con & 4) bb[w0] |= x; else bb[w0] &= xn; // turn on the blue pixel
|
|
} else {
|
|
if(w1-w0>1){ //first deal with full words
|
|
for(i=w0+1;i<w1;i++){
|
|
// draw the pixel
|
|
br[i] = 0; // turn off the red pixels
|
|
bg[i] = 0; // turn off the green pixels
|
|
bb[i] = 0; // turn off the blue pixels
|
|
if(con & 1) br[i] = 0xFFFFFFFF; // turn on the red pixels
|
|
if(con & 2) bg[i] = 0xFFFFFFFF; // turn on the green pixels
|
|
if(con & 4) bb[i] = 0xFFFFFFFF; // turn on the blue pixels
|
|
}
|
|
}
|
|
x=~a[xx0];
|
|
br[w0] &= x; // turn off the red pixel
|
|
bg[w0] &= x; // turn off the green pixel
|
|
bb[w0] &= x; // turn off the blue pixel
|
|
x=~x;
|
|
if(con & 1) br[w0] |= x; // turn on the red pixel
|
|
if(con & 2) bg[w0] |= x; // turn on the green pixel
|
|
if(con & 4) bb[w0] |= x; // turn on the blue pixel
|
|
x=~b[xx1];
|
|
br[w1] &= x; // turn off the red pixel
|
|
bg[w1] &= x; // turn off the green pixel
|
|
bb[w1] &= x; // turn off the blue pixel
|
|
x=~x;
|
|
if(con & 1) br[w1] |= x; // turn on the red pixel
|
|
if(con & 2) bg[w1] |= x; // turn on the green pixel
|
|
if(con & 4) bb[w1] |= x; // turn on the blue pixel
|
|
}
|
|
}
|
|
|
|
void DrawBufferSPI111(int x1, int y1, int x2, int y2, unsigned char* p) {
|
|
int t,x,y,w, xd, c1;
|
|
unsigned int xx, xxn;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
// make sure the coordinates are kept within the display area
|
|
if(x2 <= x1) { t = x1; x1 = x2; x2 = t; }
|
|
if(y2 <= y1) { t = y1; y1 = y2; y2 = t; }
|
|
for(y=y1;y<=y2;y++){
|
|
c1=y * (SPIints_per_line);
|
|
for(x=x1;x<=x2;x++){
|
|
xx = (0x80000000>>(x & 0x1f));
|
|
xxn=~xx;
|
|
xd=x>>5;
|
|
w = c1 + xd;
|
|
// draw the pixel
|
|
if(y>=0 && y<VRes && x>=0 && x<HRes){
|
|
if(*p++ > 0x80){
|
|
bb[w] |= xx;
|
|
} else {
|
|
bb[w] &= xxn;
|
|
}// turn on the blue pixel
|
|
if(*p++ > 0x80){
|
|
bg[w] |= xx;
|
|
} else {
|
|
bg[w] &= xxn;
|
|
}// turn on the green pixel
|
|
if(*p++ > 0x80){
|
|
br[w] |= xx;
|
|
} else {
|
|
br[w] &= xxn;
|
|
}// turn on the red pixel
|
|
} else p+=3;
|
|
}
|
|
}
|
|
}
|
|
void ReadBufferSPI111(int x1, int y1, int x2, int y2, unsigned char* p) {
|
|
int t,x,y, w, xx, xd, c1;
|
|
// make sure the coordinates are kept within the display area
|
|
if(x2 <= x1) { t = x1; x1 = x2; x2 = t; }
|
|
if(y2 <= y1) { t = y1; y1 = y2; y2 = t; }
|
|
for(y=y1;y<=y2;y++){
|
|
c1=y * (SPIints_per_line);
|
|
for(x=x1;x<=x2;x++){
|
|
xx=(0x80000000>>(x & 0x1f));
|
|
xd=x>>5;
|
|
w = c1 + xd;
|
|
if(y>=0 && y<VRes && x>=0 && x<HRes){
|
|
*p++ = ((VideoBufBlu[w]) & xx) ? 0xff : 0;
|
|
*p++ = ((VideoBufGrn[w]) & xx) ? 0xff : 0;
|
|
*p++ = ((VideoBufRed[w]) & xx) ? 0xff : 0;
|
|
} else p+=3;
|
|
}
|
|
}
|
|
}
|
|
void plot121(int x, int y, int con) {
|
|
int w, xx,xxn, xd;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
xx = (0x80000000>>(x & 0x1f));
|
|
xd=x>>5;
|
|
w = y * (SPIints_per_line) + xd;
|
|
// draw the pixel
|
|
xxn = ~xx;
|
|
if(con & 1) br[w] |= xx; else br[w] &= xxn; // turn on the red pixel
|
|
if(con & 6) bg[w] |= xx; else bg[w] &= xxn; // turn on the green pixel
|
|
if(con & 8) bb[w] |= xx; else bb[w] &= xxn; // turn on the blue pixel
|
|
}
|
|
|
|
inline void plot(int x, int y, int con) {
|
|
int w, xx,xxn, xd;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
xx = (0x80000000>>(x & 0x1f));
|
|
xd=x>>5;
|
|
w = y * (SPIints_per_line) + xd;
|
|
// draw the pixel
|
|
xxn = ~xx;
|
|
if(con & 1) br[w] |= xx; else br[w] &= xxn; // turn on the red pixel
|
|
if(con & 2) bg[w] |= xx; else bg[w] &= xxn; // turn on the green pixel
|
|
if(con & 4) bb[w] |= xx; else bb[w] &= xxn; // turn on the blue pixel
|
|
}
|
|
|
|
void copyframetoscreen(uint8_t *s,int xstart, int xend, int ystart, int yend, int odd){
|
|
int c;
|
|
int i=(xend-xstart+1)*(yend-ystart+1);
|
|
int x=xstart,y=ystart;
|
|
if(odd){
|
|
c=(*s & 0xF0)>>4;
|
|
plot121(x,y,c);
|
|
if(x==xend){
|
|
x=xstart;
|
|
y++;
|
|
} else x++;
|
|
|
|
|
|
s++;
|
|
i--;
|
|
}
|
|
while(i>0){
|
|
c=*s & 0xF;
|
|
plot121(x,y,c);
|
|
if(x==xend){
|
|
x=xstart;
|
|
y++;
|
|
} else x++;
|
|
if(i>1){
|
|
c=(*s & 0xF0)>>4;
|
|
plot121(x,y,c);
|
|
if(x==xend){
|
|
x=xstart;
|
|
y++;
|
|
} else x++;
|
|
s++;
|
|
i-=2;
|
|
}
|
|
}
|
|
}
|
|
|
|
void ScrollSPI111sideways(int lines){
|
|
int i, j;
|
|
uint32_t k, l, prevr=0, prevg=0, prevb=0;
|
|
uint32_t *pdr,*pdg,*pdb;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
int m1=0x0;
|
|
int m2=0x0;
|
|
if(lines > 0) {
|
|
for(j=0; j<VRes;j++){
|
|
pdr = br + (SPIints_per_line * j);
|
|
pdg = bg + (SPIints_per_line * j);
|
|
pdb = bb + (SPIints_per_line * j);
|
|
for(i=0;i<=HRes/32;i++){
|
|
l = *pdr;
|
|
k=l & maskSPI111[lines-1];
|
|
l = l >> lines;
|
|
l |= prevr;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdr++ = l;
|
|
prevr=k<<(32-lines);
|
|
|
|
l = *pdg;
|
|
k= l & maskSPI111[lines-1];
|
|
l = l >> lines;
|
|
l |= prevg;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdg++ = l;
|
|
prevg=k<<(32-lines);
|
|
|
|
l = *pdb;
|
|
k=l & maskSPI111[lines-1];
|
|
l = l >>lines;
|
|
l |= prevb;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdb++ = l;
|
|
prevb=k<<(32-lines);
|
|
}
|
|
}
|
|
} else {
|
|
int m=-lines;
|
|
for(j=0; j<VRes;j++){
|
|
pdr = br + HRes/32 + (SPIints_per_line * j);
|
|
pdg = bb + HRes/32 + (SPIints_per_line * j);
|
|
pdb = bg + HRes/32 + (SPIints_per_line * j);
|
|
for(i=HRes/32;i>=0;i--){
|
|
l = *pdr;
|
|
k=l & rmaskSPI111[m];
|
|
l = l << m;
|
|
l |= prevr;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdr-- = l;
|
|
prevr=k>>(32-m);
|
|
|
|
l = *pdg;
|
|
k= l & rmaskSPI111[m];
|
|
l = l << m;
|
|
l |= prevg;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdg-- = l;
|
|
prevg=k>>(32-m);
|
|
|
|
l = *pdb;
|
|
k=l & rmaskSPI111[m];
|
|
l = l << m;
|
|
l |= prevb;
|
|
if(i==0)l &= m1;
|
|
if(i==HRes/32)l &= m2;
|
|
*pdb-- = l;
|
|
prevb=k>>(32-m);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
void ScrollSPI111(int lines) {
|
|
int i,amount;
|
|
uint32_t *pdr,*pdg,*pdb;
|
|
uint32_t *psr,*psg,*psb;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
if(lines >= 0) {
|
|
amount = SPIints_per_line * (VRes - lines);
|
|
pdr = br;
|
|
psr = pdr + SPIints_per_line * lines;
|
|
pdg = bg;
|
|
psg = pdg + SPIints_per_line * lines;
|
|
pdb = bb;
|
|
psb = pdb + SPIints_per_line * lines;
|
|
for(i=0; i < amount; i+=8) {
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
}
|
|
DrawRectangle(0, VRes-lines, HRes - 1, VRes - 1, gui_bcolour); // erase the lines introduced at the bottom
|
|
} else {
|
|
lines = -lines;
|
|
amount = SPIints_per_line * (VRes - lines);
|
|
psr = br + SPIints_per_line * (VRes - lines);
|
|
pdr = psr + SPIints_per_line * lines;
|
|
psg = bg + SPIints_per_line * (VRes - lines);
|
|
pdg = psg + SPIints_per_line * lines;
|
|
psb = bb + SPIints_per_line * (VRes - lines);
|
|
pdb = psb + SPIints_per_line * lines;
|
|
for(i=0; i < amount; i+=8){
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
}
|
|
DrawRectangle(0, 0, HRes - 1, lines-1 , gui_bcolour); // erase the lines introduced at the top
|
|
}
|
|
}
|
|
void ScrollSPI111vertical(int lines, int blank) {
|
|
int i,amount;
|
|
uint32_t *pdr,*pdg,*pdb;
|
|
uint32_t *psr,*psg,*psb;
|
|
uint32_t *br, *bg, *bb;
|
|
br=VideoBufRed, bg=VideoBufGrn, bb=VideoBufBlu;
|
|
if(lines >= 0) {
|
|
amount = SPIints_per_line * (VRes - lines);
|
|
pdr = br;
|
|
psr = pdr + SPIints_per_line * lines;
|
|
pdg = bg;
|
|
psg = pdg + SPIints_per_line * lines;
|
|
pdb = bb;
|
|
psb = pdb + SPIints_per_line * lines;
|
|
for(i=0; i < amount; i+=8) {
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdr++ = *psr++; // scroll up
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdg++ = *psg++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
*pdb++ = *psb++;
|
|
}
|
|
} else {
|
|
lines = -lines;
|
|
amount = SPIints_per_line * (VRes - lines);
|
|
psr = br + SPIints_per_line * (VRes - lines);
|
|
pdr = psr + SPIints_per_line * lines;
|
|
psg = bg + SPIints_per_line * (VRes - lines);
|
|
pdg = psg + SPIints_per_line * lines;
|
|
psb = bb + SPIints_per_line * (VRes - lines);
|
|
pdb = psb + SPIints_per_line * lines;
|
|
for(i=0; i < amount; i+=8){
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdr = *--psr; // scroll down
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdg = *--psg;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
*--pdb = *--psb;
|
|
}
|
|
}
|
|
}
|