2017-10-27 20:05:04 +02:00
|
|
|
namespace brick {
|
2017-12-19 23:26:57 +01:00
|
|
|
export const LINE_HEIGHT = 12;
|
|
|
|
|
2017-07-11 14:43:12 +02:00
|
|
|
//% shim=screen::_setPixel
|
|
|
|
function _setPixel(p0: uint32, p1: uint32, mode: Draw): void { }
|
2017-07-05 14:06:58 +02:00
|
|
|
|
2017-07-11 14:43:12 +02:00
|
|
|
//% shim=screen::_blitLine
|
|
|
|
function _blitLine(xw: uint32, y: uint32, buf: Buffer, mode: Draw): void { }
|
2017-07-05 14:06:58 +02:00
|
|
|
|
2017-07-05 14:56:13 +02:00
|
|
|
function pack(x: number, y: number) {
|
2017-07-05 18:53:22 +02:00
|
|
|
return Math.clamp(0, 512, x) | (Math.clamp(0, 512, y) << 16)
|
2017-07-05 14:56:13 +02:00
|
|
|
}
|
|
|
|
|
2017-07-11 10:35:00 +02:00
|
|
|
const ones = hex`ffffffffffffffffffffffffffffffffffffffffffffffffffffffffffffffff`
|
|
|
|
|
|
|
|
function setLineCore(x: number, x1: number, y: number, mode: Draw) {
|
2017-07-11 14:43:12 +02:00
|
|
|
_blitLine(pack(x, x1 - x), y, ones, mode)
|
2017-07-11 10:35:00 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
export interface Font {
|
|
|
|
charWidth: number;
|
|
|
|
charHeight: number;
|
|
|
|
firstChar: number;
|
|
|
|
data: Buffer;
|
|
|
|
}
|
|
|
|
let currFont: Font
|
|
|
|
|
2017-07-11 15:40:27 +02:00
|
|
|
export function setFont(f: Font) {
|
|
|
|
currFont = f
|
|
|
|
}
|
|
|
|
|
2017-10-30 19:54:53 +01:00
|
|
|
export const heart = screen.imageOf(hex`f007 367f7f3e1c08`)
|
2017-07-11 10:35:00 +02:00
|
|
|
|
|
|
|
export function defaultFont(): Font {
|
|
|
|
return {
|
|
|
|
charWidth: 8,
|
|
|
|
charHeight: 8,
|
|
|
|
firstChar: 32,
|
|
|
|
// source https://github.com/dhepper/font8x8
|
|
|
|
data: hex`
|
|
|
|
0000000000000000 183C3C1818001800 3636000000000000 36367F367F363600 0C3E031E301F0C00 006333180C666300
|
|
|
|
1C361C6E3B336E00 0606030000000000 180C0606060C1800 060C1818180C0600 00663CFF3C660000 000C0C3F0C0C0000
|
|
|
|
00000000000C0C06 0000003F00000000 00000000000C0C00 6030180C06030100 3E63737B6F673E00 0C0E0C0C0C0C3F00
|
|
|
|
1E33301C06333F00 1E33301C30331E00 383C36337F307800 3F031F3030331E00 1C06031F33331E00 3F3330180C0C0C00
|
|
|
|
1E33331E33331E00 1E33333E30180E00 000C0C00000C0C00 000C0C00000C0C06 180C0603060C1800 00003F00003F0000
|
|
|
|
060C1830180C0600 1E3330180C000C00 3E637B7B7B031E00 0C1E33333F333300 3F66663E66663F00 3C66030303663C00
|
|
|
|
1F36666666361F00 7F46161E16467F00 7F46161E16060F00 3C66030373667C00 3333333F33333300 1E0C0C0C0C0C1E00
|
|
|
|
7830303033331E00 6766361E36666700 0F06060646667F00 63777F7F6B636300 63676F7B73636300 1C36636363361C00
|
|
|
|
3F66663E06060F00 1E3333333B1E3800 3F66663E36666700 1E33070E38331E00 3F2D0C0C0C0C1E00 3333333333333F00
|
|
|
|
33333333331E0C00 6363636B7F776300 6363361C1C366300 3333331E0C0C1E00 7F6331184C667F00 1E06060606061E00
|
|
|
|
03060C1830604000 1E18181818181E00 081C366300000000 00000000000000FF 0C0C180000000000 00001E303E336E00
|
|
|
|
0706063E66663B00 00001E3303331E00 3830303e33336E00 00001E333f031E00 1C36060f06060F00 00006E33333E301F
|
|
|
|
0706366E66666700 0C000E0C0C0C1E00 300030303033331E 070666361E366700 0E0C0C0C0C0C1E00 0000337F7F6B6300
|
|
|
|
00001F3333333300 00001E3333331E00 00003B66663E060F 00006E33333E3078 00003B6E66060F00 00003E031E301F00
|
|
|
|
080C3E0C0C2C1800 0000333333336E00 00003333331E0C00 0000636B7F7F3600 000063361C366300 00003333333E301F
|
|
|
|
00003F190C263F00 380C0C070C0C3800 1818180018181800 070C0C380C0C0700 6E3B000000000000 0000000000000000
|
|
|
|
`
|
|
|
|
}
|
2017-07-05 14:56:13 +02:00
|
|
|
}
|
|
|
|
|
2018-01-09 00:00:00 +01:00
|
|
|
function setPixel(on: boolean, x: number, y: number) {
|
2017-07-11 10:35:00 +02:00
|
|
|
x |= 0
|
|
|
|
y |= 0
|
2017-07-11 16:18:59 +02:00
|
|
|
if (0 <= x && x < DAL.LCD_WIDTH && 0 <= y && y < DAL.LCD_HEIGHT)
|
2017-10-25 07:05:24 +02:00
|
|
|
_setPixel(x, y, on ? Draw.Normal : Draw.Clear)
|
2017-07-05 14:56:13 +02:00
|
|
|
}
|
|
|
|
|
2017-08-08 06:50:04 +02:00
|
|
|
/**
|
2018-01-03 23:00:08 +01:00
|
|
|
* Show text on the screen at a specific line.
|
2017-08-08 06:50:04 +02:00
|
|
|
* @param text the text to print on the screen, eg: "Hello world"
|
2018-01-08 05:45:48 +01:00
|
|
|
* @param line the line number to print the text at, eg: 1
|
2017-08-08 06:50:04 +02:00
|
|
|
*/
|
2018-01-08 05:45:48 +01:00
|
|
|
//% blockId=screen_print block="show string %text|at line %line"
|
2018-01-03 23:00:08 +01:00
|
|
|
//% weight=98 group="Screen" inlineInputMode="inline" blockGap=8
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/show-string
|
2018-01-08 05:45:48 +01:00
|
|
|
//% line.min=1 line.max=10
|
|
|
|
export function showString(text: string, line: number) {
|
2018-01-03 23:00:08 +01:00
|
|
|
const NUM_LINES = 9;
|
|
|
|
const offset = 5;
|
2018-01-08 05:45:48 +01:00
|
|
|
const y = offset + (Math.clamp(0, NUM_LINES, line - 1) / (NUM_LINES + 2)) * DAL.LCD_HEIGHT;
|
2018-01-03 23:00:08 +01:00
|
|
|
brick.print(text, offset, y);
|
|
|
|
}
|
|
|
|
|
2018-01-08 05:45:48 +01:00
|
|
|
/**
|
|
|
|
* Shows a number on the screen
|
|
|
|
* @param value the numeric value
|
|
|
|
* @param line the line number to print the text at, eg: 1
|
|
|
|
*/
|
|
|
|
//% blockId=screenShowNumber block="show number %name|at line %line"
|
|
|
|
//% weight=96 group="Screen" inlineInputMode="inline" blockGap=8
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/show-number
|
2018-01-08 05:45:48 +01:00
|
|
|
//% line.min=1 line.max=10
|
|
|
|
export function showNumber(value: number, line: number) {
|
|
|
|
showString("" + value, line);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Shows a name, value pair on the screen
|
|
|
|
* @param value the numeric value
|
|
|
|
* @param line the line number to print the text at, eg: 1
|
|
|
|
*/
|
|
|
|
//% blockId=screenShowValue block="show value %name|= %text|at line %line"
|
|
|
|
//% weight=96 group="Screen" inlineInputMode="inline" blockGap=8
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/show-value
|
2018-01-08 05:45:48 +01:00
|
|
|
//% line.min=1 line.max=10
|
|
|
|
export function showValue(name: string, value: number, line: number) {
|
2018-01-09 00:00:00 +01:00
|
|
|
value = Math.round(value * 1000) / 1000;
|
2018-01-08 05:45:48 +01:00
|
|
|
showString((name ? name + ": " : "") + value, line);
|
|
|
|
}
|
|
|
|
|
2017-10-24 14:30:05 +02:00
|
|
|
export function print(text: string, x: number, y: number, mode = Draw.Normal) {
|
2017-07-11 10:35:00 +02:00
|
|
|
x |= 0
|
|
|
|
y |= 0
|
|
|
|
if (!currFont) currFont = defaultFont()
|
|
|
|
let x0 = x
|
|
|
|
let cp = 0
|
|
|
|
let byteWidth = (currFont.charWidth + 7) >> 3
|
2017-07-11 14:43:12 +02:00
|
|
|
let charSize = byteWidth * currFont.charHeight
|
2017-10-30 14:28:01 +01:00
|
|
|
let imgBuf = output.createBuffer(2 + charSize)
|
2017-07-11 15:52:37 +02:00
|
|
|
let double = (mode & Draw.Quad) ? 4 : (mode & Draw.Double) ? 2 : 1
|
2017-10-30 14:28:01 +01:00
|
|
|
imgBuf[0] = 0xf0
|
|
|
|
imgBuf[1] = currFont.charWidth
|
2017-10-30 20:03:45 +01:00
|
|
|
let img = screen.imageOf(imgBuf)
|
2017-07-11 10:35:00 +02:00
|
|
|
while (cp < text.length) {
|
|
|
|
let ch = text.charCodeAt(cp++)
|
|
|
|
if (ch == 10) {
|
2017-07-11 14:43:12 +02:00
|
|
|
y += double * currFont.charHeight + 2
|
2017-07-11 10:35:00 +02:00
|
|
|
x = x0
|
|
|
|
}
|
|
|
|
if (ch < 32) continue
|
2017-07-11 14:43:12 +02:00
|
|
|
let idx = (ch - currFont.firstChar) * charSize
|
2017-10-30 14:28:01 +01:00
|
|
|
if (idx < 0 || idx + imgBuf.length - 1 > currFont.data.length)
|
|
|
|
imgBuf.fill(0, 2)
|
2017-07-11 10:35:00 +02:00
|
|
|
else
|
2017-10-30 14:28:01 +01:00
|
|
|
imgBuf.write(2, currFont.data.slice(idx, charSize))
|
|
|
|
img.draw(x, y, mode)
|
2017-07-11 14:43:12 +02:00
|
|
|
x += double * currFont.charWidth
|
2017-07-11 10:35:00 +02:00
|
|
|
}
|
2017-07-05 14:56:13 +02:00
|
|
|
}
|
|
|
|
|
2017-11-17 07:46:51 +01:00
|
|
|
/**
|
2018-01-31 02:02:22 +01:00
|
|
|
* Show an image on the screen
|
2017-11-17 07:46:51 +01:00
|
|
|
* @param image image to draw
|
|
|
|
*/
|
2017-12-20 00:10:13 +01:00
|
|
|
//% blockId=screen_show_image block="show image %image=screen_image_picker"
|
2018-01-03 23:00:08 +01:00
|
|
|
//% weight=100 group="Screen" blockGap=8
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/show-image
|
2018-01-09 00:00:00 +01:00
|
|
|
export function showImage(image: Image) {
|
2017-11-17 07:46:51 +01:00
|
|
|
if (!image) return;
|
|
|
|
image.draw(0, 0, Draw.Normal);
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* An image
|
|
|
|
* @param image the image
|
|
|
|
*/
|
2017-12-15 23:29:10 +01:00
|
|
|
//% blockId=screen_image_picker block="%image" shim=TD_ID
|
2018-01-04 02:20:35 +01:00
|
|
|
//% image.fieldEditor="images"
|
2017-11-17 07:52:29 +01:00
|
|
|
//% image.fieldOptions.columns=6
|
2018-01-04 02:20:35 +01:00
|
|
|
//% image.fieldOptions.width=600
|
2017-11-17 07:46:51 +01:00
|
|
|
//% group="Screen" weight=0 blockHidden=1
|
2017-12-28 20:15:53 +01:00
|
|
|
export function __imagePicker(image: Image): Image {
|
2017-11-17 07:46:51 +01:00
|
|
|
return image;
|
|
|
|
}
|
2017-12-15 23:29:10 +01:00
|
|
|
|
|
|
|
/**
|
2018-01-31 02:02:22 +01:00
|
|
|
* Clear the screen
|
2017-12-15 23:29:10 +01:00
|
|
|
*/
|
2017-12-20 00:10:13 +01:00
|
|
|
//% blockId=screen_clear_screen block="clear screen"
|
2018-01-03 23:00:08 +01:00
|
|
|
//% weight=90 group="Screen"
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/clear-screen
|
2017-12-15 23:29:10 +01:00
|
|
|
export function clearScreen() {
|
|
|
|
screen.clear();
|
|
|
|
}
|
|
|
|
|
2018-01-09 00:00:00 +01:00
|
|
|
function drawRect(x: number, y: number, w: number, h: number, mode = Draw.Normal) {
|
2017-07-11 10:35:00 +02:00
|
|
|
x |= 0;
|
|
|
|
y |= 0;
|
|
|
|
w |= 0;
|
|
|
|
h |= 0;
|
|
|
|
if (x < 0) {
|
|
|
|
w += x;
|
|
|
|
x = 0;
|
|
|
|
}
|
|
|
|
if (y < 0) {
|
|
|
|
h += y;
|
|
|
|
y = 0;
|
|
|
|
}
|
|
|
|
if (w <= 0)
|
|
|
|
return;
|
|
|
|
if (h <= 0)
|
|
|
|
return;
|
2017-07-11 16:18:59 +02:00
|
|
|
let x1 = Math.min(DAL.LCD_WIDTH, x + w);
|
|
|
|
let y1 = Math.min(DAL.LCD_HEIGHT, y + h);
|
2017-07-11 10:35:00 +02:00
|
|
|
if (w == 1) {
|
|
|
|
while (y < y1)
|
2017-07-11 14:43:12 +02:00
|
|
|
_setPixel(x, y++, mode);
|
2017-07-11 10:35:00 +02:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
setLineCore(x, x1, y++, mode);
|
|
|
|
while (y < y1 - 1) {
|
|
|
|
if (mode & Draw.Fill) {
|
|
|
|
setLineCore(x, x1, y, mode);
|
|
|
|
} else {
|
2017-07-11 14:43:12 +02:00
|
|
|
_setPixel(x, y, mode);
|
|
|
|
_setPixel(x1 - 1, y, mode);
|
2017-07-11 10:35:00 +02:00
|
|
|
}
|
|
|
|
y++;
|
|
|
|
}
|
|
|
|
if (y < y1)
|
|
|
|
setLineCore(x, x1, y, mode);
|
2017-07-05 14:56:13 +02:00
|
|
|
}
|
2017-07-11 10:35:00 +02:00
|
|
|
|
2017-12-19 23:26:57 +01:00
|
|
|
/**
|
2018-01-31 02:02:22 +01:00
|
|
|
* Print the port states on the screen
|
2017-12-19 23:26:57 +01:00
|
|
|
*/
|
|
|
|
//% blockId=brickPrintPorts block="print ports"
|
2018-01-31 02:02:22 +01:00
|
|
|
//% help=brick/print-ports
|
2017-12-19 23:26:57 +01:00
|
|
|
//% weight=1 group="Screen"
|
|
|
|
export function printPorts() {
|
2018-01-08 18:08:59 +01:00
|
|
|
const col = 44;
|
2017-12-19 23:26:57 +01:00
|
|
|
clearScreen();
|
|
|
|
|
2018-01-08 18:08:59 +01:00
|
|
|
function scale(x: number) {
|
|
|
|
if (Math.abs(x) > 1000) return Math.round(x / 100) / 10 + "k";
|
|
|
|
return ("" + (x >> 0));
|
|
|
|
}
|
|
|
|
|
2017-12-19 23:26:57 +01:00
|
|
|
// motors
|
|
|
|
const datas = motors.getAllMotorData();
|
|
|
|
for(let i = 0; i < datas.length; ++i) {
|
|
|
|
const data = datas[i];
|
2018-01-03 17:24:54 +01:00
|
|
|
if (!data.actualSpeed && !data.count) continue;
|
2018-01-08 18:08:59 +01:00
|
|
|
const x = i * col;
|
|
|
|
print(`${scale(data.actualSpeed)}%`, x, brick.LINE_HEIGHT)
|
|
|
|
print(`${scale(data.count)}>`, x, 2 * brick.LINE_HEIGHT)
|
|
|
|
print(`${scale(data.tachoCount)}|`, x, 3 * brick.LINE_HEIGHT)
|
2017-12-19 23:26:57 +01:00
|
|
|
}
|
2017-07-11 10:35:00 +02:00
|
|
|
|
2017-12-19 23:26:57 +01:00
|
|
|
// sensors
|
|
|
|
const sis = sensors.internal.getActiveSensors();
|
|
|
|
for(let i =0; i < sis.length; ++i) {
|
|
|
|
const si = sis[i];
|
2018-01-08 18:08:59 +01:00
|
|
|
const x = (si.port() - 1) * col;
|
2018-01-03 17:24:54 +01:00
|
|
|
const v = si._query();
|
2018-01-08 18:08:59 +01:00
|
|
|
print(`${scale(v)}`, x, 9 * brick.LINE_HEIGHT)
|
2017-12-19 23:26:57 +01:00
|
|
|
}
|
|
|
|
}
|
2017-07-05 14:06:58 +02:00
|
|
|
}
|