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