SmartWheels self-driving race car. Designed for NXP Cup. Uses FRDM-KL25Z, area-scan camera, and simple image processing to detect and navigate any NXP spec track.
Dependencies: TSI USBDevice mbed-dev
Fork of SmartWheels by
Hardwares/ArduUTFT.cpp@100:ffbeefc9e218, 2017-04-20 (annotated)
- Committer:
- hazheng
- Date:
- Thu Apr 20 21:04:10 2017 +0000
- Revision:
- 100:ffbeefc9e218
- Parent:
- 97:0ed9ede9a995
Better version of Intersection detection.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
hazheng | 40:be98219930e4 | 1 | #include "ArduUTFT.h" |
hazheng | 40:be98219930e4 | 2 | |
hazheng | 57:0d8a155d511d | 3 | //#define SW_DEBUG |
hazheng | 40:be98219930e4 | 4 | #include "GlobalVariable.h" |
hazheng | 56:7d3395ae022d | 5 | |
hazheng | 42:c4e1606087ff | 6 | #include "ArduUTFTFont.h" |
hazheng | 40:be98219930e4 | 7 | |
hazheng | 40:be98219930e4 | 8 | extern SPI g_spi_port; |
hazheng | 40:be98219930e4 | 9 | |
hazheng | 40:be98219930e4 | 10 | #define UTFT_DISP_TRANS_MODE 8 |
hazheng | 40:be98219930e4 | 11 | |
hazheng | 40:be98219930e4 | 12 | |
hazheng | 40:be98219930e4 | 13 | #define swap(type, i, j) {type t = i; i = j; j = t;} |
hazheng | 40:be98219930e4 | 14 | |
hazheng | 40:be98219930e4 | 15 | |
hazheng | 46:a5eb9bd3bb55 | 16 | #ifdef __cplusplus |
hazheng | 46:a5eb9bd3bb55 | 17 | extern "C" { |
hazheng | 46:a5eb9bd3bb55 | 18 | #endif |
hazheng | 46:a5eb9bd3bb55 | 19 | |
hazheng | 40:be98219930e4 | 20 | |
hazheng | 46:a5eb9bd3bb55 | 21 | static uint8_t * current_font = NULL; |
hazheng | 46:a5eb9bd3bb55 | 22 | static uint8_t font_x_size = 0; |
hazheng | 46:a5eb9bd3bb55 | 23 | static uint8_t font_y_size = 0; |
hazheng | 46:a5eb9bd3bb55 | 24 | static uint8_t font_offset = 0; |
hazheng | 46:a5eb9bd3bb55 | 25 | //static uint8_t font_numchars = 0; |
hazheng | 46:a5eb9bd3bb55 | 26 | |
hazheng | 46:a5eb9bd3bb55 | 27 | static uint8_t front_color_high = 0; |
hazheng | 46:a5eb9bd3bb55 | 28 | static uint8_t front_color_low = 0; |
hazheng | 46:a5eb9bd3bb55 | 29 | |
hazheng | 46:a5eb9bd3bb55 | 30 | |
hazheng | 46:a5eb9bd3bb55 | 31 | static DigitalOut utft_cs(PIN_AUC_CS, 1); |
hazheng | 46:a5eb9bd3bb55 | 32 | static DigitalOut utft_sd_cs(PIN_AUC_SD_CS, 1); |
hazheng | 41:7b21c5e3599e | 33 | |
Bobymicjohn | 97:0ed9ede9a995 | 34 | inline void ardu_utft_spi_write_8(int address, int value) |
hazheng | 40:be98219930e4 | 35 | { |
hazheng | 40:be98219930e4 | 36 | utft_cs = 0; |
hazheng | 40:be98219930e4 | 37 | g_spi_port.write(address | 0x80); |
hazheng | 40:be98219930e4 | 38 | g_spi_port.write(value); |
hazheng | 40:be98219930e4 | 39 | utft_cs = 1; |
hazheng | 40:be98219930e4 | 40 | } |
hazheng | 40:be98219930e4 | 41 | |
Bobymicjohn | 97:0ed9ede9a995 | 42 | inline uint8_t ardu_utft_spi_read_8(int address) |
hazheng | 79:bdbac82c979b | 43 | { |
hazheng | 40:be98219930e4 | 44 | utft_cs = 0; |
hazheng | 40:be98219930e4 | 45 | g_spi_port.write(address & 0x7F); |
hazheng | 40:be98219930e4 | 46 | uint8_t value = static_cast<uint8_t>(g_spi_port.write(0x00)); |
hazheng | 40:be98219930e4 | 47 | utft_cs = 1; |
hazheng | 79:bdbac82c979b | 48 | |
hazheng | 40:be98219930e4 | 49 | return value; |
hazheng | 40:be98219930e4 | 50 | } |
hazheng | 40:be98219930e4 | 51 | |
hazheng | 41:7b21c5e3599e | 52 | inline void ardu_utft_write_COM_internal(uint8_t VL) |
hazheng | 40:be98219930e4 | 53 | { |
hazheng | 40:be98219930e4 | 54 | utft_cs = 0; |
hazheng | 40:be98219930e4 | 55 | g_spi_port.write(0xBE); |
hazheng | 40:be98219930e4 | 56 | g_spi_port.write(VL); |
hazheng | 40:be98219930e4 | 57 | utft_cs = 1; |
hazheng | 40:be98219930e4 | 58 | } |
hazheng | 40:be98219930e4 | 59 | |
hazheng | 41:7b21c5e3599e | 60 | inline void ardu_utft_write_DATA_internal(uint8_t VH, uint8_t VL) |
hazheng | 40:be98219930e4 | 61 | { |
hazheng | 40:be98219930e4 | 62 | utft_cs = 0; |
hazheng | 40:be98219930e4 | 63 | g_spi_port.write(0xBF); |
hazheng | 40:be98219930e4 | 64 | g_spi_port.write(VH); |
hazheng | 41:7b21c5e3599e | 65 | utft_cs = 1; |
hazheng | 41:7b21c5e3599e | 66 | utft_cs = 0; |
hazheng | 40:be98219930e4 | 67 | g_spi_port.write(0xBF); |
hazheng | 40:be98219930e4 | 68 | g_spi_port.write(VL); |
hazheng | 40:be98219930e4 | 69 | utft_cs = 1; |
hazheng | 79:bdbac82c979b | 70 | |
hazheng | 40:be98219930e4 | 71 | } |
hazheng | 40:be98219930e4 | 72 | |
hazheng | 41:7b21c5e3599e | 73 | inline void ardu_utft_write_COM_DATA_internal(uint8_t com1, uint16_t dat1) |
hazheng | 40:be98219930e4 | 74 | { |
hazheng | 41:7b21c5e3599e | 75 | ardu_utft_write_COM_internal(com1); |
hazheng | 41:7b21c5e3599e | 76 | ardu_utft_write_DATA_internal((dat1 >> 8) & 0xFF, dat1); |
hazheng | 41:7b21c5e3599e | 77 | } |
hazheng | 41:7b21c5e3599e | 78 | |
hazheng | 41:7b21c5e3599e | 79 | void ardu_utft_write_DATA(uint8_t VH, uint8_t VL) |
hazheng | 41:7b21c5e3599e | 80 | { |
hazheng | 41:7b21c5e3599e | 81 | ardu_utft_write_DATA_internal(VH, VL); |
hazheng | 40:be98219930e4 | 82 | } |
hazheng | 40:be98219930e4 | 83 | |
hazheng | 40:be98219930e4 | 84 | void ardu_utft_init() |
hazheng | 40:be98219930e4 | 85 | { |
Bobymicjohn | 97:0ed9ede9a995 | 86 | uint8_t VerNum = ardu_utft_spi_read_8(ARDUCHIP_VER_UTFT); |
Bobymicjohn | 97:0ed9ede9a995 | 87 | VerNum = ardu_utft_spi_read_8(ARDUCHIP_VER_UTFT); |
hazheng | 40:be98219930e4 | 88 | |
Bobymicjohn | 97:0ed9ede9a995 | 89 | ardu_utft_spi_write_8(ARDUCHIP_TEST1_UTFT, ARDUCHIP_TEST_MSG_UTFT); |
Bobymicjohn | 97:0ed9ede9a995 | 90 | uint8_t testV = ardu_utft_spi_read_8(ARDUCHIP_TEST1_UTFT); |
hazheng | 40:be98219930e4 | 91 | if(VerNum != ARDUCHIP_VER_NUM_UTFT || testV != ARDUCHIP_TEST_MSG_UTFT) |
hazheng | 40:be98219930e4 | 92 | { |
hazheng | 96:ec89c4d1383d | 93 | |
hazheng | 40:be98219930e4 | 94 | } |
hazheng | 40:be98219930e4 | 95 | else |
hazheng | 40:be98219930e4 | 96 | { |
hazheng | 96:ec89c4d1383d | 97 | |
hazheng | 40:be98219930e4 | 98 | } |
hazheng | 40:be98219930e4 | 99 | |
hazheng | 40:be98219930e4 | 100 | ardu_cam_set_mode(MCU2LCD_MODE); |
hazheng | 41:7b21c5e3599e | 101 | ardu_utft_write_COM_DATA_internal(0x00,0x0001); |
hazheng | 41:7b21c5e3599e | 102 | ardu_utft_write_COM_DATA_internal(0x03,0xA8A4); |
hazheng | 41:7b21c5e3599e | 103 | ardu_utft_write_COM_DATA_internal(0x0C,0x0000); |
hazheng | 41:7b21c5e3599e | 104 | ardu_utft_write_COM_DATA_internal(0x0D,0x080C); |
hazheng | 41:7b21c5e3599e | 105 | ardu_utft_write_COM_DATA_internal(0x0E,0x2B00); |
hazheng | 41:7b21c5e3599e | 106 | ardu_utft_write_COM_DATA_internal(0x1E,0x00B7); |
hazheng | 41:7b21c5e3599e | 107 | ardu_utft_write_COM_DATA_internal(0x01,0x6B3F); //693F |
hazheng | 41:7b21c5e3599e | 108 | ardu_utft_write_COM_DATA_internal(0x02,0x0600); |
hazheng | 41:7b21c5e3599e | 109 | ardu_utft_write_COM_DATA_internal(0x10,0x0000); |
hazheng | 41:7b21c5e3599e | 110 | ardu_utft_write_COM_DATA_internal(0x11,0x6078); |
hazheng | 41:7b21c5e3599e | 111 | ardu_utft_write_COM_DATA_internal(0x05,0x0000); |
hazheng | 41:7b21c5e3599e | 112 | ardu_utft_write_COM_DATA_internal(0x06,0x0000); |
hazheng | 41:7b21c5e3599e | 113 | ardu_utft_write_COM_DATA_internal(0x16,0xEF1C); |
hazheng | 41:7b21c5e3599e | 114 | ardu_utft_write_COM_DATA_internal(0x17,0x0003); |
hazheng | 41:7b21c5e3599e | 115 | ardu_utft_write_COM_DATA_internal(0x07,0x0233); |
hazheng | 41:7b21c5e3599e | 116 | ardu_utft_write_COM_DATA_internal(0x0B,0x0000); |
hazheng | 41:7b21c5e3599e | 117 | ardu_utft_write_COM_DATA_internal(0x0F,0x0000); |
hazheng | 41:7b21c5e3599e | 118 | ardu_utft_write_COM_DATA_internal(0x41,0x0000); |
hazheng | 41:7b21c5e3599e | 119 | ardu_utft_write_COM_DATA_internal(0x42,0x0000); |
hazheng | 41:7b21c5e3599e | 120 | ardu_utft_write_COM_DATA_internal(0x48,0x0000); |
hazheng | 41:7b21c5e3599e | 121 | ardu_utft_write_COM_DATA_internal(0x49,0x013F); |
hazheng | 41:7b21c5e3599e | 122 | ardu_utft_write_COM_DATA_internal(0x4A,0x0000); |
hazheng | 41:7b21c5e3599e | 123 | ardu_utft_write_COM_DATA_internal(0x4B,0x0000); |
hazheng | 41:7b21c5e3599e | 124 | ardu_utft_write_COM_DATA_internal(0x44,0xEF00); |
hazheng | 41:7b21c5e3599e | 125 | ardu_utft_write_COM_DATA_internal(0x45,0x0000); |
hazheng | 41:7b21c5e3599e | 126 | ardu_utft_write_COM_DATA_internal(0x46,0x013F); |
hazheng | 41:7b21c5e3599e | 127 | ardu_utft_write_COM_DATA_internal(0x30,0x0707); |
hazheng | 41:7b21c5e3599e | 128 | ardu_utft_write_COM_DATA_internal(0x31,0x0204); |
hazheng | 41:7b21c5e3599e | 129 | ardu_utft_write_COM_DATA_internal(0x32,0x0204); |
hazheng | 41:7b21c5e3599e | 130 | ardu_utft_write_COM_DATA_internal(0x33,0x0502); |
hazheng | 41:7b21c5e3599e | 131 | ardu_utft_write_COM_DATA_internal(0x34,0x0507); |
hazheng | 41:7b21c5e3599e | 132 | ardu_utft_write_COM_DATA_internal(0x35,0x0204); |
hazheng | 41:7b21c5e3599e | 133 | ardu_utft_write_COM_DATA_internal(0x36,0x0204); |
hazheng | 41:7b21c5e3599e | 134 | ardu_utft_write_COM_DATA_internal(0x37,0x0502); |
hazheng | 41:7b21c5e3599e | 135 | ardu_utft_write_COM_DATA_internal(0x3A,0x0302); |
hazheng | 41:7b21c5e3599e | 136 | ardu_utft_write_COM_DATA_internal(0x3B,0x0302); |
hazheng | 41:7b21c5e3599e | 137 | ardu_utft_write_COM_DATA_internal(0x23,0x0000); |
hazheng | 41:7b21c5e3599e | 138 | ardu_utft_write_COM_DATA_internal(0x24,0x0000); |
hazheng | 41:7b21c5e3599e | 139 | ardu_utft_write_COM_DATA_internal(0x25,0x8000); |
hazheng | 41:7b21c5e3599e | 140 | ardu_utft_write_COM_DATA_internal(0x4f,0x0000); |
hazheng | 41:7b21c5e3599e | 141 | ardu_utft_write_COM_DATA_internal(0x4e,0x0000); |
hazheng | 41:7b21c5e3599e | 142 | ardu_utft_write_COM_internal(0x22); |
hazheng | 41:7b21c5e3599e | 143 | |
hazheng | 42:c4e1606087ff | 144 | ardu_utft_set_font(SmallFont); |
hazheng | 40:be98219930e4 | 145 | ardu_utft_clr_scr(); |
hazheng | 40:be98219930e4 | 146 | |
hazheng | 40:be98219930e4 | 147 | } |
hazheng | 40:be98219930e4 | 148 | |
hazheng | 40:be98219930e4 | 149 | void ardu_cam_set_mode(uint8_t mode) |
hazheng | 40:be98219930e4 | 150 | { |
Bobymicjohn | 97:0ed9ede9a995 | 151 | ardu_utft_spi_write_8(ARDUCHIP_MODE, MCU2LCD_MODE); |
hazheng | 40:be98219930e4 | 152 | } |
hazheng | 40:be98219930e4 | 153 | |
hazheng | 40:be98219930e4 | 154 | void ardu_utft_clr_scr() |
hazheng | 40:be98219930e4 | 155 | { |
hazheng | 40:be98219930e4 | 156 | ardu_utft_reset_xy(); |
hazheng | 40:be98219930e4 | 157 | |
hazheng | 40:be98219930e4 | 158 | long i; |
hazheng | 40:be98219930e4 | 159 | for (i = 0; i < ((UTFT_DISP_X_SIZE + 1) * (UTFT_DISP_Y_SIZE + 1)); ++i) |
hazheng | 40:be98219930e4 | 160 | { |
hazheng | 41:7b21c5e3599e | 161 | ardu_utft_write_DATA_internal(0x00,0x00); |
hazheng | 40:be98219930e4 | 162 | } |
hazheng | 40:be98219930e4 | 163 | } |
hazheng | 40:be98219930e4 | 164 | |
hazheng | 40:be98219930e4 | 165 | void ardu_utft_reset_xy() |
hazheng | 40:be98219930e4 | 166 | { |
hazheng | 40:be98219930e4 | 167 | ardu_utft_set_xy(0, 0, UTFT_DISP_Y_SIZE, UTFT_DISP_X_SIZE); |
hazheng | 40:be98219930e4 | 168 | } |
hazheng | 40:be98219930e4 | 169 | |
hazheng | 40:be98219930e4 | 170 | void ardu_utft_set_xy(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2) |
hazheng | 40:be98219930e4 | 171 | { |
hazheng | 40:be98219930e4 | 172 | ///////////////////////////// |
hazheng | 40:be98219930e4 | 173 | //Possible to be simplified |
hazheng | 40:be98219930e4 | 174 | swap(uint16_t, x1, y1); |
hazheng | 40:be98219930e4 | 175 | swap(uint16_t, x2, y2); |
hazheng | 42:c4e1606087ff | 176 | //y1 = UTFT_DISP_Y_SIZE - y1; //319 - 0 = 319 |
hazheng | 42:c4e1606087ff | 177 | //y2 = UTFT_DISP_Y_SIZE - y2; //319 - 300 = 19 |
hazheng | 42:c4e1606087ff | 178 | //swap(uint16_t, y1, y2); //y1 = 19, y2 = 319 |
hazheng | 40:be98219930e4 | 179 | ///////////////////////////// |
hazheng | 40:be98219930e4 | 180 | |
hazheng | 41:7b21c5e3599e | 181 | ardu_utft_write_COM_DATA_internal(0x44, (x2 << 8) + x1); |
hazheng | 42:c4e1606087ff | 182 | ardu_utft_write_COM_DATA_internal(0x45, UTFT_DISP_Y_SIZE - y2); //19 |
hazheng | 42:c4e1606087ff | 183 | ardu_utft_write_COM_DATA_internal(0x46, UTFT_DISP_Y_SIZE - y1); //319 |
hazheng | 41:7b21c5e3599e | 184 | ardu_utft_write_COM_DATA_internal(0x4e, x1); |
hazheng | 42:c4e1606087ff | 185 | ardu_utft_write_COM_DATA_internal(0x4f, UTFT_DISP_Y_SIZE - y2); |
hazheng | 41:7b21c5e3599e | 186 | ardu_utft_write_COM_internal(0x22); |
hazheng | 40:be98219930e4 | 187 | } |
hazheng | 40:be98219930e4 | 188 | |
hazheng | 40:be98219930e4 | 189 | void ardu_utft_set_color(uint8_t r, uint8_t g, uint8_t b) |
hazheng | 40:be98219930e4 | 190 | { |
hazheng | 40:be98219930e4 | 191 | front_color_high = ((r & 248) | g >> 5); |
hazheng | 40:be98219930e4 | 192 | front_color_low = ((g & 28) << 3 | b >> 3); |
hazheng | 40:be98219930e4 | 193 | } |
hazheng | 40:be98219930e4 | 194 | |
hazheng | 40:be98219930e4 | 195 | void ardu_utft_draw_rect(int x1, int y1, int x2, int y2) |
hazheng | 40:be98219930e4 | 196 | { |
hazheng | 40:be98219930e4 | 197 | if (x1>x2) |
hazheng | 40:be98219930e4 | 198 | { |
hazheng | 40:be98219930e4 | 199 | swap(int, x1, x2); |
hazheng | 40:be98219930e4 | 200 | } |
hazheng | 40:be98219930e4 | 201 | if (y1>y2) |
hazheng | 40:be98219930e4 | 202 | { |
hazheng | 40:be98219930e4 | 203 | swap(int, y1, y2); |
hazheng | 40:be98219930e4 | 204 | } |
hazheng | 40:be98219930e4 | 205 | |
hazheng | 40:be98219930e4 | 206 | ardu_utft_draw_hline(x1, y1, x2 - x1); |
hazheng | 40:be98219930e4 | 207 | ardu_utft_draw_hline(x1, y2, x2 - x1); |
hazheng | 40:be98219930e4 | 208 | ardu_utft_draw_vline(x1, y1, y2 - y1); |
hazheng | 40:be98219930e4 | 209 | ardu_utft_draw_vline(x2, y1, y2 - y1); |
hazheng | 40:be98219930e4 | 210 | } |
hazheng | 40:be98219930e4 | 211 | |
hazheng | 40:be98219930e4 | 212 | void ardu_utft_draw_hline(int x, int y, int l) |
hazheng | 40:be98219930e4 | 213 | { |
hazheng | 40:be98219930e4 | 214 | if (l<0) |
hazheng | 40:be98219930e4 | 215 | { |
hazheng | 40:be98219930e4 | 216 | l = -l; |
hazheng | 40:be98219930e4 | 217 | x -= l; |
hazheng | 40:be98219930e4 | 218 | } |
hazheng | 40:be98219930e4 | 219 | |
hazheng | 40:be98219930e4 | 220 | ardu_utft_set_xy(x, y, x+l, y); |
hazheng | 40:be98219930e4 | 221 | |
hazheng | 40:be98219930e4 | 222 | for (int i = 0; i < l + 1; ++i) |
hazheng | 40:be98219930e4 | 223 | { |
hazheng | 41:7b21c5e3599e | 224 | ardu_utft_write_DATA_internal(front_color_high, front_color_low); |
hazheng | 40:be98219930e4 | 225 | } |
hazheng | 40:be98219930e4 | 226 | |
hazheng | 40:be98219930e4 | 227 | ardu_utft_reset_xy(); |
hazheng | 40:be98219930e4 | 228 | } |
hazheng | 40:be98219930e4 | 229 | |
hazheng | 40:be98219930e4 | 230 | void ardu_utft_draw_vline(int x, int y, int l) |
hazheng | 40:be98219930e4 | 231 | { |
hazheng | 40:be98219930e4 | 232 | if (l<0) |
hazheng | 40:be98219930e4 | 233 | { |
hazheng | 40:be98219930e4 | 234 | l = -l; |
hazheng | 40:be98219930e4 | 235 | y -= l; |
hazheng | 40:be98219930e4 | 236 | } |
hazheng | 40:be98219930e4 | 237 | |
hazheng | 40:be98219930e4 | 238 | ardu_utft_set_xy(x, y, x, y+l); |
hazheng | 40:be98219930e4 | 239 | |
hazheng | 40:be98219930e4 | 240 | for (int i = 0; i < l + 1; ++i) |
hazheng | 40:be98219930e4 | 241 | { |
hazheng | 41:7b21c5e3599e | 242 | ardu_utft_write_DATA_internal(front_color_high, front_color_low); |
hazheng | 40:be98219930e4 | 243 | } |
hazheng | 40:be98219930e4 | 244 | |
hazheng | 40:be98219930e4 | 245 | ardu_utft_reset_xy(); |
hazheng | 42:c4e1606087ff | 246 | } |
hazheng | 42:c4e1606087ff | 247 | |
hazheng | 42:c4e1606087ff | 248 | |
hazheng | 42:c4e1606087ff | 249 | void ardu_utft_draw_pixel(int x, int y) |
hazheng | 42:c4e1606087ff | 250 | { |
hazheng | 42:c4e1606087ff | 251 | ardu_utft_set_xy(x, y, x, y); |
hazheng | 42:c4e1606087ff | 252 | ardu_utft_write_DATA_internal(front_color_high, front_color_low); |
hazheng | 42:c4e1606087ff | 253 | ardu_utft_reset_xy(); |
hazheng | 42:c4e1606087ff | 254 | } |
hazheng | 42:c4e1606087ff | 255 | |
hazheng | 42:c4e1606087ff | 256 | void ardu_utft_fill_rect(int x1, int y1, int x2, int y2) |
hazheng | 42:c4e1606087ff | 257 | { |
hazheng | 42:c4e1606087ff | 258 | if (x1 > x2) |
hazheng | 42:c4e1606087ff | 259 | { |
hazheng | 42:c4e1606087ff | 260 | swap(int, x1, x2); |
hazheng | 42:c4e1606087ff | 261 | } |
hazheng | 42:c4e1606087ff | 262 | if (y1 > y2) |
hazheng | 42:c4e1606087ff | 263 | { |
hazheng | 42:c4e1606087ff | 264 | swap(int, y1, y2); |
hazheng | 42:c4e1606087ff | 265 | } |
hazheng | 42:c4e1606087ff | 266 | |
hazheng | 42:c4e1606087ff | 267 | for (int i = 0; i < ((x2 - x1) / 2) + 1; ++i) |
hazheng | 42:c4e1606087ff | 268 | { |
hazheng | 42:c4e1606087ff | 269 | ardu_utft_draw_vline(x1 + i, y1, y2 - y1); |
hazheng | 42:c4e1606087ff | 270 | ardu_utft_draw_vline(x2 - i, y1, y2 - y1); |
hazheng | 42:c4e1606087ff | 271 | } |
hazheng | 42:c4e1606087ff | 272 | } |
hazheng | 42:c4e1606087ff | 273 | |
hazheng | 42:c4e1606087ff | 274 | void ardu_utft_set_font(uint8_t * font) |
hazheng | 42:c4e1606087ff | 275 | { |
hazheng | 42:c4e1606087ff | 276 | current_font = font; |
hazheng | 42:c4e1606087ff | 277 | font_x_size = font[0]; |
hazheng | 42:c4e1606087ff | 278 | font_y_size = font[1]; |
hazheng | 42:c4e1606087ff | 279 | font_offset = font[2]; |
hazheng | 46:a5eb9bd3bb55 | 280 | //font_numchars = font[3]; |
hazheng | 42:c4e1606087ff | 281 | } |
hazheng | 42:c4e1606087ff | 282 | |
hazheng | 42:c4e1606087ff | 283 | void ardu_utft_print_char(char c, int x, int y) |
hazheng | 42:c4e1606087ff | 284 | { |
hazheng | 42:c4e1606087ff | 285 | char i, ch; |
hazheng | 42:c4e1606087ff | 286 | |
hazheng | 42:c4e1606087ff | 287 | uint16_t temp = ((c - font_offset) * ((font_x_size / 8) * font_y_size)) + 4; |
hazheng | 42:c4e1606087ff | 288 | |
hazheng | 42:c4e1606087ff | 289 | for(uint8_t j = 0; j < font_y_size; ++j) |
hazheng | 42:c4e1606087ff | 290 | { |
hazheng | 42:c4e1606087ff | 291 | for (int zz = 0; zz < (font_x_size / 8); ++zz) |
hazheng | 42:c4e1606087ff | 292 | { |
hazheng | 42:c4e1606087ff | 293 | ch = current_font[temp + zz]; |
hazheng | 42:c4e1606087ff | 294 | for(i = 0; i < 8; ++i) |
hazheng | 42:c4e1606087ff | 295 | { |
hazheng | 42:c4e1606087ff | 296 | ardu_utft_set_xy(x + i + (zz * 8), y + j, x + i + (zz * 8) + 1, y + j + 1); |
hazheng | 42:c4e1606087ff | 297 | |
hazheng | 42:c4e1606087ff | 298 | if((ch & (1 << i)) != 0) |
hazheng | 42:c4e1606087ff | 299 | { |
hazheng | 42:c4e1606087ff | 300 | ardu_utft_write_DATA_internal(front_color_high, front_color_low); |
hazheng | 56:7d3395ae022d | 301 | } |
hazheng | 56:7d3395ae022d | 302 | else |
hazheng | 56:7d3395ae022d | 303 | { |
hazheng | 56:7d3395ae022d | 304 | ardu_utft_write_DATA_internal(0x00, 0x00); |
hazheng | 56:7d3395ae022d | 305 | } |
hazheng | 42:c4e1606087ff | 306 | } |
hazheng | 42:c4e1606087ff | 307 | } |
hazheng | 42:c4e1606087ff | 308 | temp += (font_x_size / 8); |
hazheng | 42:c4e1606087ff | 309 | } |
hazheng | 42:c4e1606087ff | 310 | |
hazheng | 42:c4e1606087ff | 311 | ardu_utft_reset_xy(); |
hazheng | 42:c4e1606087ff | 312 | } |
hazheng | 42:c4e1606087ff | 313 | |
hazheng | 42:c4e1606087ff | 314 | void ardu_utft_print(char * st, int x, int y) |
hazheng | 42:c4e1606087ff | 315 | { |
hazheng | 42:c4e1606087ff | 316 | int stl, i; |
hazheng | 42:c4e1606087ff | 317 | stl = strlen(st); |
hazheng | 42:c4e1606087ff | 318 | |
hazheng | 42:c4e1606087ff | 319 | if (x == UTFT_RIGHT) |
hazheng | 42:c4e1606087ff | 320 | x = (UTFT_DISP_Y_SIZE + 1) - (stl * font_x_size); |
hazheng | 42:c4e1606087ff | 321 | if (x == UTFT_CENTER) |
hazheng | 42:c4e1606087ff | 322 | x = ((UTFT_DISP_Y_SIZE + 1) - (stl * font_x_size)) / 2; |
hazheng | 42:c4e1606087ff | 323 | |
hazheng | 42:c4e1606087ff | 324 | for (i = 0; i < stl; ++i) |
hazheng | 42:c4e1606087ff | 325 | ardu_utft_print_char(*st++, x - (i * (font_x_size)), y); |
hazheng | 46:a5eb9bd3bb55 | 326 | } |
hazheng | 46:a5eb9bd3bb55 | 327 | |
Bobymicjohn | 97:0ed9ede9a995 | 328 | uint8_t ardu_utft_get_ver_num() |
Bobymicjohn | 97:0ed9ede9a995 | 329 | { |
Bobymicjohn | 97:0ed9ede9a995 | 330 | return ardu_utft_spi_read_8(ARDUCHIP_VER_UTFT); |
Bobymicjohn | 97:0ed9ede9a995 | 331 | } |
Bobymicjohn | 97:0ed9ede9a995 | 332 | |
hazheng | 46:a5eb9bd3bb55 | 333 | #ifdef __cplusplus |
hazheng | 46:a5eb9bd3bb55 | 334 | } |
hazheng | 46:a5eb9bd3bb55 | 335 | #endif |