1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889 |
-
- #include <avr/io.h>
- #include <stdint.h>
- #include <stdlib.h>
- #include <serial.h>
- #include <strings.h>
-
- uint8_t *buffNew(void) {
- uint8_t *tmp = (uint8_t *)malloc(64);
- if (tmp == NULL) {
- #ifdef DEBUG
- serialWriteString(getString(24));
- #endif
- while(1);
- }
- return tmp;
- }
-
- void buffSetPixel(uint8_t *buffer, uint8_t x, uint8_t y, uint8_t z) {
- buffer[(8 * z) + (7 - y)] |= (1 << x);
- }
-
- void buffClearPixel(uint8_t *buffer, uint8_t x, uint8_t y, uint8_t z) {
- buffer[(8 * z) + (7 - y)] &= ~(1 << x);
- }
-
- void buffFillRect(uint8_t *buffer, uint8_t x1, uint8_t y1, uint8_t z1,
- uint8_t x2, uint8_t y2, uint8_t z2, uint8_t value) {
- uint8_t depth, depthMax, depthMin, x, xMax, xMin, y, yMax, yMin;
-
- if (z1 <= z2) {
- depthMin = z1;
- depthMax = z2;
- } else {
- depthMin = z2;
- depthMax = z1;
- }
- if (x1 <= x2) {
- xMin = x1;
- xMax = x2;
- } else {
- xMin = x2;
- xMax = x1;
- }
- if (y1 <= y2) {
- yMin = y1;
- yMax = y2;
- } else {
- yMin = y2;
- yMax = y1;
- }
- for (depth = depthMin; depth <= depthMax; depth++) {
-
- for (x = xMin; x <= xMax; x++) {
- for (y = yMin; y <= yMax; y++) {
- if (value) {
- buffSetPixel(buffer, x, y, depth);
- } else {
- buffClearPixel(buffer, x, y, depth);
- }
- }
- }
- }
- }
-
- void buffFree(uint8_t *buffer) {
- free(buffer);
- }
|