#include "vend.h"
void delay(u16 ms) {
- /* delay routine written in assembly so we know what we're really getting.
- * each inner loop should take ~1 ms to execute.
- * 15 cycles * (1/4.9152Mhz) * 327 = 0.997 ms + a little bit on the fringes.
- *
- * XXX - how do we know gcc isn't optimising this? it seems to optimise after
- * parsing C -> asm, but before asm -> machine code.
- */
- //asm volatile ("pshx\npsha\npshb\n"); /* save registers */
asm volatile ("ldx %0\n" :: "m" (ms) : "x");
asm volatile (
"delay_loop:\n"
- //" ldd #327\n" /* 3 */
" ldd #150\n" /* 3 */
"delay_inner_loop:\n" /* 15 cycles each */
" cpd #0x0000\n" /* 5 */
" beq delay_out\n" /* 3 */
" bra delay_loop\n" /* 3 */
"delay_out:\n" ::: "x", "d");
- /*" pulb\n"
- " pula\n"
- " pulx\n");*/
+}
+
+u8 my_strlen(char* s) {
+ char *p = s;
+ while (*p) p++;
+ return p-s;
}
void my_strncpy(char* dst, char* src, u8 max_size) {
char* c;
for (c = dst; c < dst+count; c++) *c = val;
}
+
+u8 hexchar2u8(char b) {
+ if (b >= '0' && b <= '9') return b-'0';
+ if (b >= 'a' && b <= 'f') return b-'a'+0x0a;
+ if (b >= 'A' && b <= 'F') return b-'A'+0x0a;
+ return 0;
+}
+
+char nibble2hexchar(u8 b) {
+ if (b <= 9) return b+'0';
+ if (b >= 10 && b <= 15) return b+'A'-10;
+ return 'X';
+}
+
+u8 hex2u8(char msb, char lsb) {
+ return (hexchar2u8(msb) << 4) + hexchar2u8(lsb);
+}
+
+static char hexconv_buf[3];
+char* u82hex(u8 a) {
+ hexconv_buf[0] = nibble2hexchar((a&0xf0) >> 4);
+ hexconv_buf[1] = nibble2hexchar(a&0x0f);
+ hexconv_buf[2] = '\0';
+ return hexconv_buf;
+}
+
+bool ishex(char b) {
+ if (b >= '0' && b <= '9') return 1;
+ if (b >= 'a' && b <= 'f') return 1;
+ if (b >= 'A' && b <= 'F') return 1;
+ return 0;
+}
+