stuff

Author: celerizer

device.c

@@ -3,6 +3,7 @@
 #include "devices/buttons.h"
 #include "devices/eeprom.h"
 #include "devices/factory_control.h"
+#include "devices/lcd.h"
 #include "devices/led.h"
 #include "system.h"
 #include "types.h"
@@ -55,7 +56,6 @@ static const h8_system_preset_t h8_systems[] =
     { 0xd4a05446, 0 },
     {
       { 1, H8_DEVICE_LCD, H8_HOOKUP_PORT_1, H8_HOOKUP_SELECT_0, NULL, NULL /* SSU select */ },
-      { 1, H8_DEVICE_LCD, H8_HOOKUP_PORT_1, H8_HOOKUP_SELECT_1, NULL, NULL /* 0=cmd 1=data */ },
 
       { 2, H8_DEVICE_EEPROM_64K, H8_HOOKUP_PORT_1, H8_HOOKUP_SELECT_2, h8_eeprom_read, h8_eeprom_write },
 
@@ -99,7 +99,7 @@ h8_bool h8_device_init(h8_device_t *device, const h8_device_id type)
       device->init = h8_factory_control_init;
       break;
     case H8_DEVICE_LCD:
-      device->init = NULL; /** @todo */
+      device->init = h8_lcd_init;
       break;
     case H8_DEVICE_LED:
       device->init = h8_led_init;

devices/lcd.c

@@ -4,10 +4,36 @@
 static const char *name = "128x64 LCD device";
 static const h8_device_id type = H8_DEVICE_LCD;
 
+typedef struct
+{
+  h8_u8 vram[128 * 64];
+} h8_lcd_t;
+
+void h8_lcd_read(h8_device_t *device, h8_byte_t *dst)
+{
+  h8_lcd_t *m_lcd = device->device;
+
+  /** @todo */
+  dst->u = m_lcd->vram[0];
+}
+
+void h8_lcd_write(h8_device_t *device, h8_byte_t *dst, const h8_byte_t value)
+{
+  h8_lcd_t *m_lcd = device->device;
+
+  /** @todo */
+  m_lcd->vram[0] = value.u;
+}
+
 void h8_lcd_init(h8_device_t *device)
 {
   if (device)
   {
+    h8_lcd_t *m_lcd = h8_dma_alloc(sizeof(h8_lcd_t), TRUE);
+
+    device->device = m_lcd;
+    device->read = h8_lcd_read;
+    device->write = h8_lcd_write;
     device->name = name;
     device->type = type;
   }

emu.c

@@ -145,11 +145,13 @@ H8_OUT(pdr1o)
         !(system->devices[i].select & value.u))
     {
       system->ssu_device = &system->devices[i];
+      printf("Using %s as port 1 device\n", system->devices[i].name);
       *byte = value;
       return;
     }
   }
   system->ssu_device = NULL;
+  printf("Couldn't find port 1 device for %u\n", value.u);
   *byte = value;
 }
 
@@ -226,6 +228,7 @@ H8_OUT(pdrbo)
 
 H8_IN(sssri)
 {
+  system->vmem.parts.io1.ssu.sssr.flags.tdre = 1;
   *byte = system->vmem.parts.io1.ssu.sssr.raw;
 }
 
@@ -1118,8 +1121,8 @@ H8_OP(op01)
     }
     break;
   case 0x80:
-    /** @todo SLEEP */
-    H8_ERROR(H8_DEBUG_UNIMPLEMENTED_OPCODE)
+    /** SLEEP */
+    system->sleep = TRUE;
     break;
   case 0xC0:
     H8_ERROR(H8_DEBUG_UNIMPLEMENTED_OPCODE)

system.h

@@ -262,16 +262,15 @@ typedef struct h8_system_t
 
   h8_device_t devices[H8_DEVICES_MAX];
 
-  /**
-   * The number of devices initialized within `devices`
-   */
+  /** The number of devices initialized within `devices` */
   unsigned device_count;
 
-  /**
-   * A pointer to the device the SSU is currently interacting with
-   */
+  /** A pointer to the device the SSU is currently interacting with */
   h8_device_t *ssu_device;
 
+  /** Whether or not SLEEP mode is currently active */
+  h8_bool sleep;
+
 #if H8_PROFILING
   unsigned instructions;
   unsigned char reads[0x10000];