1 #include "display_basic.h"
5 asm volatile ("ldx %0\n" :: "m" (ms) : "x");
9 "delay_inner_loop:\n" /* 15 cycles each */
10 " cpd #0x0000\n" /* 5 */
11 " beq delay_inner_loop_end\n" /* 3 */
12 " subd #0x0001\n" /* 4 */
13 " bra delay_inner_loop\n" /* 3 */
14 "delay_inner_loop_end:\n"
16 " beq delay_out\n" /* 3 */
17 " bra delay_loop\n" /* 3 */
18 "delay_out:\n" ::: "x", "d");
21 u8 my_strlen(char* s) {
27 void my_strncpy(char* dst, char* src, u8 max_size) {
29 for (i = 0; src[i] && i < max_size; i++) dst[i] = src[i];
30 if (src[i] == 0 && i < max_size) dst[i] = 0; /* null terminator */
33 bool my_strncmp(char* a, char* b, u8 len) {
35 for (i = 0; i < len; i++) {
36 if (*a != *b) return 0;
43 void my_memcpy(char* dst, char* src, u8 size) {
45 for (i = 0; i < size; i++) dst[i] = src[i];
48 void my_memset(char* dst, u8 val, u16 count) {
50 for (c = dst; c < dst+count; c++) *c = val;
53 u8 hexchar2u8(char b) {
54 if (b >= '0' && b <= '9') return b-'0';
55 if (b >= 'a' && b <= 'f') return b-'a'+0x0a;
56 if (b >= 'A' && b <= 'F') return b-'A'+0x0a;
60 char nibble2hexchar(u8 b) {
61 if (b <= 9) return b+'0';
62 if (b >= 10 && b <= 15) return b+'A'-10;
66 u8 hex2u8(char msb, char lsb) {
67 return (hexchar2u8(msb) << 4) + hexchar2u8(lsb);
70 static char hexconv_buf[3];
72 hexconv_buf[0] = nibble2hexchar((a&0xf0) >> 4);
73 hexconv_buf[1] = nibble2hexchar(a&0x0f);
74 hexconv_buf[2] = '\0';
79 if (b >= '0' && b <= '9') return 1;
80 if (b >= 'a' && b <= 'f') return 1;
81 if (b >= 'A' && b <= 'F') return 1;