1 #include <stdio.h> 2 #include <stdlib.h> 3 #include <string.h> 4 #include <fcntl.h> 5 #include <unistd.h> 6 #include <sys/stat.h> 7 #include <sys/mman.h> 8 #include <errno.h> 9 10 #include <openbmc_intf.h> 11 #include <openbmc.h> 12 13 /* ------------------------------------------------------------------------- */ 14 static const gchar* dbus_object_path = "/org/openbmc/control"; 15 static const gchar* instance_name = "host0"; 16 static const gchar* dbus_name = "org.openbmc.control.Host"; 17 18 static GDBusObjectManagerServer *manager = NULL; 19 20 #define PPC_BIT32(bit) (0x80000000UL >> (bit)) 21 22 #define FSI_EXTERNAL_MODE_PATH "/sys/devices/platform/gpio-fsi/external_mode" 23 #define FSI_SCAN_PATH "/sys/class/fsi-master/fsi0/rescan" 24 25 /* TODO: Change this over to the cfam path once the cfam chardev patches have landed */ 26 #define FSI_RAW_PATH "/sys/class/fsi-master/fsi0/slave@00:00/raw" 27 28 #define FSI_SCAN_DELAY_US 10000 29 30 /* Attention registers */ 31 #define FSI_A_SI1S 0x081c 32 #define TRUE_MASK 0x100d 33 #define INTERRUPT_STATUS_REG 0x100b 34 35 /* SBE boot register and values */ 36 #define SBE_VITAL 0x281c 37 #define SBE_WARMSTART PPC_BIT32(0) 38 #define SBE_HW_TRIGGER PPC_BIT32(2) 39 #define SBE_UPDATE_1ST_NIBBLE PPC_BIT32(3) 40 #define SBE_IMAGE_SELECT PPC_BIT32(8) 41 #define SBE_UPDATE_3RD_NIBBLE PPC_BIT32(11) 42 43 /* Once the side is selected and attention bits are set, this starts the SBE */ 44 #define START_SBE (SBE_WARMSTART | SBE_HW_TRIGGER | SBE_UPDATE_1ST_NIBBLE) 45 46 /* Primary is first side. Golden is second side */ 47 #define PRIMARY_SIDE (SBE_HW_TRIGGER | SBE_UPDATE_1ST_NIBBLE) 48 #define GOLDEN_SIDE (SBE_HW_TRIGGER | SBE_UPDATE_1ST_NIBBLE | \ 49 SBE_IMAGE_SELECT | SBE_UPDATE_3RD_NIBBLE) 50 51 static gboolean on_init(Control * control,GDBusMethodInvocation * invocation,gpointer user_data)52 on_init(Control *control, 53 GDBusMethodInvocation *invocation, 54 gpointer user_data) 55 { 56 (void) user_data; 57 control_complete_init(control,invocation); 58 return TRUE; 59 } 60 61 static gint fsi_putcfam(int fd,uint64_t addr64,uint32_t val_host)62 fsi_putcfam(int fd, uint64_t addr64, uint32_t val_host) 63 { 64 int rc; 65 uint32_t val = htobe32(val_host); 66 /* Map FSI to FSI_BYTE, as the 'raw' kernel interface expects this */ 67 uint32_t addr = (addr64 & 0x7ffc00) | ((addr64 & 0x3ff) << 2); 68 69 rc = lseek(fd, addr, SEEK_SET); 70 if (rc < 0) { 71 g_print("ERROR HostControl: cfam seek failed (0x%08x): %s\n", addr, 72 strerror(errno)); 73 return errno; 74 }; 75 76 rc = write(fd, &val, sizeof(val)); 77 if (rc < 0) { 78 g_print("ERROR HostControl: cfam write failed: %s\n", 79 strerror(errno)); 80 return errno; 81 } 82 83 return 0; 84 } 85 fsi_rescan(void)86 static int fsi_rescan(void) 87 { 88 char *one = "1"; 89 int fd, rc; 90 91 fd = open(FSI_SCAN_PATH, O_WRONLY); 92 if (fd < 0) { 93 g_print("ERROR HostControl: Failed to open path '%s': %s\n", 94 FSI_SCAN_PATH, strerror(errno)); 95 return errno; 96 } 97 rc = write(fd, one, sizeof(*one)); 98 close(fd); 99 if (rc < 0) { 100 g_print("ERROR HostControl: Failed to perform FSI scan: %s\n", 101 strerror(errno)); 102 return errno; 103 } 104 g_print("HostControl: Performing FSI scan (delay %d us)\n", 105 FSI_SCAN_DELAY_US); 106 usleep(FSI_SCAN_DELAY_US); 107 108 return 0; 109 } 110 111 static gboolean on_boot(ControlHost * host,GDBusMethodInvocation * invocation,gpointer user_data)112 on_boot(ControlHost *host, 113 GDBusMethodInvocation *invocation, 114 gpointer user_data) 115 { 116 (void) user_data; 117 int rc, cfam_fd; 118 119 if(control_host_get_debug_mode(host)==1) { 120 int fd; 121 char *one = "1"; 122 g_print("Enabling debug mode; not booting host\n"); 123 fd = open(FSI_EXTERNAL_MODE_PATH, O_RDWR); 124 if (fd < 0) { 125 g_print("ERROR HostControl: Failed to open path '%s'\n", 126 FSI_EXTERNAL_MODE_PATH); 127 return TRUE; 128 } 129 rc = write(fd, one, sizeof(*one)); 130 if (rc < 0) { 131 g_print("ERROR HostControl: Failed to enable debug mode '%s'\n", 132 FSI_EXTERNAL_MODE_PATH); 133 } 134 close(fd); 135 return TRUE; 136 } 137 g_print("Booting host\n"); 138 139 rc = fsi_rescan(); 140 if (rc < 0) 141 return FALSE; 142 143 cfam_fd = open(FSI_RAW_PATH, O_RDWR); 144 if (cfam_fd < 0) { 145 g_print("ERROR HostControl: Failed to open '%s'\n", FSI_RAW_PATH); 146 return FALSE; 147 } 148 149 control_host_complete_boot(host,invocation); 150 do { 151 rc = fsi_putcfam(cfam_fd, FSI_A_SI1S, 0x20000000); 152 rc |= fsi_putcfam(cfam_fd, TRUE_MASK, 0x40000000); 153 rc |= fsi_putcfam(cfam_fd, INTERRUPT_STATUS_REG, 0xFFFFFFFF); 154 if(rc) { break; } 155 156 const gchar* flash_side = control_host_get_flash_side(host); 157 g_print("Using %s side of the bios flash\n",flash_side); 158 if(strcmp(flash_side,"primary")==0) { 159 rc |= fsi_putcfam(cfam_fd, SBE_VITAL, PRIMARY_SIDE); 160 } else if(strcmp(flash_side,"golden") == 0) { 161 rc |= fsi_putcfam(cfam_fd, SBE_VITAL, GOLDEN_SIDE); 162 } else { 163 g_print("ERROR: Invalid flash side: %s\n",flash_side); 164 rc = 0xff; 165 166 } 167 if(rc) { break; } 168 169 rc = fsi_putcfam(cfam_fd, SBE_VITAL, START_SBE); 170 } while(0); 171 if(rc) 172 { 173 g_print("ERROR HostControl: SBE sequence failed (rc=%d)\n",rc); 174 } 175 /* Close file descriptor */ 176 close(cfam_fd); 177 178 control_host_emit_booted(host); 179 180 return TRUE; 181 } 182 183 static void on_bus_acquired(GDBusConnection * connection,const gchar * name,gpointer user_data)184 on_bus_acquired(GDBusConnection *connection, 185 const gchar *name, 186 gpointer user_data) 187 { 188 (void) name; 189 (void) user_data; 190 191 ObjectSkeleton *object; 192 //g_print ("Acquired a message bus connection: %s\n",name); 193 manager = g_dbus_object_manager_server_new(dbus_object_path); 194 195 gchar *s; 196 s = g_strdup_printf("%s/%s",dbus_object_path,instance_name); 197 object = object_skeleton_new(s); 198 g_free(s); 199 200 ControlHost* control_host = control_host_skeleton_new(); 201 object_skeleton_set_control_host(object, control_host); 202 g_object_unref(control_host); 203 204 Control* control = control_skeleton_new(); 205 object_skeleton_set_control(object, control); 206 g_object_unref(control); 207 208 //define method callbacks here 209 g_signal_connect(control_host, 210 "handle-boot", 211 G_CALLBACK(on_boot), 212 object); /* user_data */ 213 g_signal_connect(control, 214 "handle-init", 215 G_CALLBACK(on_init), 216 NULL); /* user_data */ 217 218 control_host_set_debug_mode(control_host,0); 219 control_host_set_flash_side(control_host,"primary"); 220 221 /* Export the object (@manager takes its own reference to @object) */ 222 g_dbus_object_manager_server_set_connection(manager, connection); 223 g_dbus_object_manager_server_export(manager, G_DBUS_OBJECT_SKELETON(object)); 224 g_object_unref(object); 225 } 226 227 static void on_name_acquired(GDBusConnection * connection,const gchar * name,gpointer user_data)228 on_name_acquired(GDBusConnection *connection, 229 const gchar *name, 230 gpointer user_data) 231 { 232 (void) connection; 233 (void) name; 234 (void) user_data; 235 // g_print ("Acquired the name %s\n", name); 236 } 237 238 static void on_name_lost(GDBusConnection * connection,const gchar * name,gpointer user_data)239 on_name_lost(GDBusConnection *connection, 240 const gchar *name, 241 gpointer user_data) 242 { 243 (void) connection; 244 (void) name; 245 (void) user_data; 246 // g_print ("Lost the name %s\n", name); 247 } 248 249 gint main(gint argc,gchar * argv[])250 main(gint argc, gchar *argv[]) 251 { 252 GMainLoop *loop; 253 cmdline cmd; 254 cmd.argc = argc; 255 cmd.argv = argv; 256 257 guint id; 258 loop = g_main_loop_new(NULL, FALSE); 259 260 id = g_bus_own_name(DBUS_TYPE, 261 dbus_name, 262 G_BUS_NAME_OWNER_FLAGS_ALLOW_REPLACEMENT | 263 G_BUS_NAME_OWNER_FLAGS_REPLACE, 264 on_bus_acquired, 265 on_name_acquired, 266 on_name_lost, 267 &cmd, 268 NULL); 269 270 g_main_loop_run(loop); 271 272 g_bus_unown_name(id); 273 g_main_loop_unref(loop); 274 return 0; 275 } 276