+#include "display_basic.h"
#include "vend.h"
-/* some IO addresses require buffering, so we create some generic buffering
- * functions here
- */
-
-/* create port-specific #defines: */
-#define buffered_port(p) \
- u8 addr_##p##_buffer = 0; \
- \
- void __inline__ outb_##p(u8 b) { \
- addr_##p##_buffer = b; \
- outb(p, b); \
- } \
- \
- void __inline__ bset_##p(u8 mask) { \
- bset((addr_t)&addr_##p##_buffer, mask); \
- outb(p, addr_##p##_buffer); \
- } \
- \
- void __inline__ bclr_##p(u8 mask) { \
- bclr((addr_t)&addr_##p##_buffer, mask); \
- outb(p, addr_##p##_buffer); \
- }
-
-void __inline__ outb(addr_t addr, u8 byte) {
- /* FIXME hmmm */
- /* asm? */
-}
-
-void __inline__ bset(addr_t addr, u8 mask) {
- /* FIXME again. asm? */
+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));
+ asm volatile (
+ "delay_loop:\n"
+ " dex\n" /* 3 */
+ " beq delay_out\n" /* 3 */
+ " ldd #327\n" /* 3 */
+ "delay_inner_loop:\n" /* 15 cycles each */
+ " cpd #0x0000\n" /* 5 */
+ " beq delay_inner_loop_end\n" /* 3 */
+ " subd #0x0001\n" /* 4 */
+ " bra delay_inner_loop\n" /* 3 */
+ "delay_inner_loop_end:\n"
+ " bra delay_loop\n" /* 3 */
+ "delay_out:\n");
+ /*" pulb\n"
+ " pula\n"
+ " pulx\n");*/
}
-void __inline__ bclr(addr_t addr, u8 mask) {
- /* FIXME again. asm? */
+void my_strncpy(char* dst, char* src, u8 max_size) {
+ u8 i;
+ for (i = 0; src[i] && i < max_size; i++) dst[i] = src[i];
+ if (src[i] == 0 && i < max_size) dst[i] = 0; /* null terminator */
}
-void delay(u16 ms) {
- /* FIXME fill me in */
+void my_memcpy(char* dst, char* src, u8 size) {
+ u8 i = 0;
+ for (i = 0; i < size; i++) dst[i] = src[i];
}
-
-/* ports declared here must be defined with buffered_port_h() in vend.h too */
-buffered_port(3800);
-