Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 1 | #include <stdint.h>
|
| 2 | #include <stdio.h>
|
| 3 | #include <stdlib.h>
|
| 4 | #include <string.h>
|
| 5 | #include <fcntl.h>
|
| 6 | #include <unistd.h>
|
| 7 | #include <sys/stat.h>
|
| 8 | #include <sys/mman.h>
|
| 9 | #include "interfaces/openbmc_intf.h"
|
| 10 | #include "openbmc.h"
|
| 11 | #include "gpio.h"
|
| 12 |
|
| 13 | /* ---------------------------------------------------------------------------------------------------- */
|
| 14 | static const gchar* dbus_object_path = "/org/openbmc/control";
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 15 | static const gchar* instance_name = "bmc0";
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 16 | static const gchar* dbus_name = "org.openbmc.control.Bmc";
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame^] | 17 | static const gchar* i2c_dev = "/sys/bus/i2c/devices";
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 18 |
|
| 19 | //this probably should come from some global SOC config
|
| 20 |
|
| 21 | #define LPC_BASE (off_t)0x1e789000
|
| 22 | #define LPC_HICR6 0x80
|
| 23 | #define LPC_HICR7 0x88
|
| 24 | #define LPC_HICR8 0x8c
|
| 25 | #define SPI_BASE (off_t)0x1e630000
|
| 26 | #define SCU_BASE (off_t)0x1e780000
|
| 27 | #define UART_BASE (off_t)0x1e783000
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 28 | #define COM_BASE (off_t)0x1e789000
|
| 29 | #define COM_BASE2 (off_t)0x1e789100
|
| 30 | #define GPIO_BASE (off_t)0x1e6e2000
|
| 31 |
|
| 32 | static GDBusObjectManagerServer *manager = NULL;
|
| 33 |
|
| 34 | void* memmap(int mem_fd,off_t base)
|
| 35 | {
|
| 36 | void* bmcreg;
|
| 37 | bmcreg = mmap(NULL, getpagesize(),
|
| 38 | PROT_READ | PROT_WRITE, MAP_SHARED, mem_fd, base);
|
| 39 |
|
| 40 | if (bmcreg == MAP_FAILED) {
|
| 41 | printf("ERROR: Unable to map LPC register memory");
|
| 42 | exit(1);
|
| 43 | }
|
| 44 | return bmcreg;
|
| 45 | }
|
| 46 |
|
| 47 | void reg_init()
|
| 48 | {
|
| 49 | g_print("BMC init\n");
|
| 50 | // BMC init done here
|
| 51 |
|
| 52 | void *bmcreg;
|
| 53 | int mem_fd = open("/dev/mem", O_RDWR | O_SYNC);
|
| 54 | if (mem_fd < 0) {
|
| 55 | printf("ERROR: Unable to open /dev/mem");
|
| 56 | exit(1);
|
| 57 | }
|
| 58 |
|
| 59 | bmcreg = memmap(mem_fd,LPC_BASE);
|
| 60 | devmem(bmcreg+LPC_HICR6,0x00000500); //Enable LPC FWH cycles, Enable LPC to AHB bridge
|
Norman James | c54a629 | 2015-10-31 17:35:17 -0500 | [diff] [blame] | 61 | devmem(bmcreg+LPC_HICR7,0x30000C00); //32M PNOR
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 62 | devmem(bmcreg+LPC_HICR8,0xFC0003FF);
|
| 63 |
|
| 64 | //flash controller
|
| 65 | bmcreg = memmap(mem_fd,SPI_BASE);
|
| 66 | devmem(bmcreg+0x00,0x00000003);
|
| 67 | devmem(bmcreg+0x04,0x00002404);
|
| 68 |
|
| 69 | //UART
|
| 70 |
|
| 71 |
|
| 72 | bmcreg = memmap(mem_fd,UART_BASE);
|
| 73 | devmem(bmcreg+0x00,0x00000000); //Set Baud rate divisor -> 13 (Baud 115200)
|
| 74 | devmem(bmcreg+0x04,0x00000000); //Set Baud rate divisor -> 13 (Baud 115200)
|
| 75 | devmem(bmcreg+0x08,0x000000c1); //Disable Parity, 1 stop bit, 8 bits
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 76 | bmcreg = memmap(mem_fd,COM_BASE);
|
| 77 | devmem(bmcreg+0x9C,0x08060000); //Set UART routing
|
| 78 |
|
| 79 | bmcreg = memmap(mem_fd,SCU_BASE);
|
| 80 | devmem(bmcreg+0x00,0x9f82fce7);
|
| 81 | devmem(bmcreg+0x04,0x0370e677);
|
| 82 | devmem(bmcreg+0x20,0xcfc8f7ff);
|
| 83 | devmem(bmcreg+0x24,0xc738f20a);
|
| 84 | devmem(bmcreg+0x80,0x0031ffaf);
|
| 85 |
|
| 86 |
|
| 87 | //GPIO
|
| 88 | bmcreg = memmap(mem_fd,GPIO_BASE);
|
| 89 | devmem(bmcreg+0x84,0x00fff0c0); //Enable UART1
|
| 90 | devmem(bmcreg+0x70,0x120CE406);
|
| 91 | devmem(bmcreg+0x80,0xCB000000);
|
| 92 | devmem(bmcreg+0x88,0x01C000FF);
|
| 93 | devmem(bmcreg+0x8c,0xC1C000FF);
|
| 94 | devmem(bmcreg+0x90,0x003FA009);
|
| 95 | devmem(bmcreg+0x88,0x01C0007F);
|
| 96 |
|
| 97 |
|
| 98 | bmcreg = memmap(mem_fd,COM_BASE);
|
| 99 | devmem(bmcreg+0x170,0x00000042);
|
| 100 | devmem(bmcreg+0x174,0x00004000);
|
| 101 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 102 | close(mem_fd);
|
| 103 | }
|
| 104 |
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame^] | 105 | int init_i2c_driver(int i2c_bus, const char* device, int address,bool delete)
|
| 106 | {
|
| 107 | char dev[255];
|
| 108 | if (!delete) {
|
| 109 | sprintf(dev,"%s/%d/new_device",i2c_dev,i2c_bus);
|
| 110 | } else {
|
| 111 | sprintf(dev,"%s/%d/delete_device",i2c_dev,i2c_bus);
|
| 112 | }
|
| 113 | int fd = open(dev, O_WRONLY);
|
| 114 | if (fd == -1) {
|
| 115 | return 1;
|
| 116 | }
|
| 117 | sprintf(dev,"%s %02x",device,address);
|
| 118 | int rc = write(fd,dev,strlen(dev));
|
| 119 | close(fd);
|
| 120 | if (rc != strlen(dev)) {
|
| 121 | return 2;
|
| 122 | }
|
| 123 | return 0;
|
| 124 | }
|
| 125 |
|
| 126 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 127 | static gboolean
|
| 128 | on_init (Control *control,
|
| 129 | GDBusMethodInvocation *invocation,
|
| 130 | gpointer user_data)
|
| 131 | {
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 132 | //#ifdef __arm__
|
| 133 | //reg_init();
|
| 134 | //#endif
|
| 135 | control_complete_init(control,invocation);
|
| 136 | //control_emit_goto_system_state(control,"BMC_STARTING");
|
| 137 |
|
| 138 | return TRUE;
|
| 139 | }
|
| 140 | gboolean go(gpointer user_data)
|
| 141 | {
|
| 142 | cmdline *cmd = user_data;
|
| 143 | Control* control = object_get_control((Object*)cmd->user_data);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 144 | #ifdef __arm__
|
| 145 | reg_init();
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame^] | 146 | init_i2c_driver(6,"nct7904",0x2d,false);
|
| 147 | init_i2c_driver(6,"nct7904",0x2d,true);
|
| 148 | init_i2c_driver(6,"nct7904",0x2d,false);
|
| 149 |
|
| 150 | init_i2c_driver(6,"nct7904",0x2e,false);
|
| 151 | init_i2c_driver(6,"nct7904",0x2e,true);
|
| 152 | init_i2c_driver(6,"nct7904",0x2e,false);
|
| 153 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 154 | #endif
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 155 | control_emit_goto_system_state(control,"BMC_STARTING");
|
| 156 |
|
Norman James | e7e3076 | 2015-10-28 20:27:02 -0500 | [diff] [blame] | 157 | //g_main_loop_quit(cmd->loop);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 158 | return FALSE;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 159 | }
|
| 160 |
|
| 161 | static void
|
| 162 | on_bus_acquired (GDBusConnection *connection,
|
| 163 | const gchar *name,
|
| 164 | gpointer user_data)
|
| 165 | {
|
| 166 | ObjectSkeleton *object;
|
| 167 | cmdline *cmd = user_data;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 168 | manager = g_dbus_object_manager_server_new (dbus_object_path);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 169 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 170 | gchar *s;
|
| 171 | s = g_strdup_printf ("%s/%s",dbus_object_path,instance_name);
|
| 172 | object = object_skeleton_new (s);
|
| 173 | g_free (s);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 174 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 175 | ControlBmc* control_bmc = control_bmc_skeleton_new ();
|
| 176 | object_skeleton_set_control_bmc (object, control_bmc);
|
| 177 | g_object_unref (control_bmc);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 178 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 179 | Control* control = control_skeleton_new ();
|
| 180 | object_skeleton_set_control (object, control);
|
| 181 | g_object_unref (control);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 182 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 183 | //define method callbacks here
|
| 184 | g_signal_connect (control,
|
| 185 | "handle-init",
|
| 186 | G_CALLBACK (on_init),
|
| 187 | NULL); /* user_data */
|
| 188 |
|
| 189 | /* Export the object (@manager takes its own reference to @object) */
|
| 190 | g_dbus_object_manager_server_export (manager, G_DBUS_OBJECT_SKELETON (object));
|
| 191 | g_object_unref (object);
|
| 192 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 193 | /* Export all objects */
|
| 194 | g_dbus_object_manager_server_set_connection (manager, connection);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 195 |
|
| 196 | //TODO: This is a bad hack to wait for object to be on bus
|
| 197 | //sleep(1);
|
| 198 | cmd->user_data = object;
|
| 199 | g_idle_add(go,cmd);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 200 | }
|
| 201 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 202 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 203 | static void
|
| 204 | on_name_acquired (GDBusConnection *connection,
|
| 205 | const gchar *name,
|
| 206 | gpointer user_data)
|
| 207 | {
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 208 |
|
| 209 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 210 | }
|
| 211 |
|
| 212 | static void
|
| 213 | on_name_lost (GDBusConnection *connection,
|
| 214 | const gchar *name,
|
| 215 | gpointer user_data)
|
| 216 | {
|
| 217 | }
|
| 218 |
|
| 219 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 220 | /*----------------------------------------------------------------*/
|
| 221 | /* Main Event Loop */
|
| 222 |
|
| 223 | gint
|
| 224 | main (gint argc, gchar *argv[])
|
| 225 | {
|
| 226 | GMainLoop *loop;
|
| 227 | cmdline cmd;
|
| 228 | cmd.argc = argc;
|
| 229 | cmd.argv = argv;
|
| 230 |
|
| 231 | guint id;
|
| 232 | loop = g_main_loop_new (NULL, FALSE);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 233 | cmd.loop = loop;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 234 |
|
| 235 | id = g_bus_own_name (DBUS_TYPE,
|
| 236 | dbus_name,
|
| 237 | G_BUS_NAME_OWNER_FLAGS_ALLOW_REPLACEMENT |
|
| 238 | G_BUS_NAME_OWNER_FLAGS_REPLACE,
|
| 239 | on_bus_acquired,
|
| 240 | on_name_acquired,
|
| 241 | on_name_lost,
|
| 242 | &cmd,
|
| 243 | NULL);
|
| 244 |
|
| 245 | g_main_loop_run (loop);
|
| 246 |
|
| 247 | g_bus_unown_name (id);
|
| 248 | g_main_loop_unref (loop);
|
| 249 | return 0;
|
| 250 | }
|