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];
|
Norman James | 4fa8e4f | 2015-11-11 10:41:38 -0600 | [diff] [blame] | 108 | g_print("Initing: device = %s, address = %02x\n",device,address);
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 109 | if (!delete) {
|
Norman James | 372d788 | 2015-11-11 12:48:44 -0600 | [diff] [blame] | 110 | sprintf(dev,"%s/i2c-%d/new_device",i2c_dev,i2c_bus);
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 111 | } else {
|
Norman James | 372d788 | 2015-11-11 12:48:44 -0600 | [diff] [blame] | 112 | sprintf(dev,"%s/i2c-%d/delete_device",i2c_dev,i2c_bus);
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 113 | }
|
| 114 | int fd = open(dev, O_WRONLY);
|
| 115 | if (fd == -1) {
|
Norman James | 4fa8e4f | 2015-11-11 10:41:38 -0600 | [diff] [blame] | 116 | g_print("ERROR control_bmc: Unable to open device %s\n",dev);
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 117 | return 1;
|
| 118 | }
|
Norman James | 372d788 | 2015-11-11 12:48:44 -0600 | [diff] [blame] | 119 | if (!delete) {
|
| 120 | sprintf(dev,"%s 0x%02x",device,address);
|
| 121 | } else {
|
| 122 | sprintf(dev,"0x%02x",address);
|
| 123 | }
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 124 | int rc = write(fd,dev,strlen(dev));
|
| 125 | close(fd);
|
| 126 | if (rc != strlen(dev)) {
|
Norman James | 4fa8e4f | 2015-11-11 10:41:38 -0600 | [diff] [blame] | 127 | g_print("ERROR control_bmc: Unable to write %s\n",dev);
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 128 | return 2;
|
| 129 | }
|
| 130 | return 0;
|
| 131 | }
|
| 132 |
|
| 133 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 134 | static gboolean
|
| 135 | on_init (Control *control,
|
| 136 | GDBusMethodInvocation *invocation,
|
| 137 | gpointer user_data)
|
| 138 | {
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 139 | //#ifdef __arm__
|
| 140 | //reg_init();
|
| 141 | //#endif
|
| 142 | control_complete_init(control,invocation);
|
| 143 | //control_emit_goto_system_state(control,"BMC_STARTING");
|
| 144 |
|
| 145 | return TRUE;
|
| 146 | }
|
| 147 | gboolean go(gpointer user_data)
|
| 148 | {
|
| 149 | cmdline *cmd = user_data;
|
| 150 | Control* control = object_get_control((Object*)cmd->user_data);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 151 | #ifdef __arm__
|
| 152 | reg_init();
|
Norman James | 2a76020 | 2015-11-11 10:31:26 -0600 | [diff] [blame] | 153 | init_i2c_driver(6,"nct7904",0x2d,false);
|
| 154 | init_i2c_driver(6,"nct7904",0x2d,true);
|
| 155 | init_i2c_driver(6,"nct7904",0x2d,false);
|
| 156 |
|
| 157 | init_i2c_driver(6,"nct7904",0x2e,false);
|
| 158 | init_i2c_driver(6,"nct7904",0x2e,true);
|
| 159 | init_i2c_driver(6,"nct7904",0x2e,false);
|
| 160 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 161 | #endif
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 162 | control_emit_goto_system_state(control,"BMC_STARTING");
|
| 163 |
|
Norman James | e7e3076 | 2015-10-28 20:27:02 -0500 | [diff] [blame] | 164 | //g_main_loop_quit(cmd->loop);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 165 | return FALSE;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 166 | }
|
| 167 |
|
| 168 | static void
|
| 169 | on_bus_acquired (GDBusConnection *connection,
|
| 170 | const gchar *name,
|
| 171 | gpointer user_data)
|
| 172 | {
|
| 173 | ObjectSkeleton *object;
|
| 174 | cmdline *cmd = user_data;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 175 | manager = g_dbus_object_manager_server_new (dbus_object_path);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 176 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 177 | gchar *s;
|
| 178 | s = g_strdup_printf ("%s/%s",dbus_object_path,instance_name);
|
| 179 | object = object_skeleton_new (s);
|
| 180 | g_free (s);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 181 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 182 | ControlBmc* control_bmc = control_bmc_skeleton_new ();
|
| 183 | object_skeleton_set_control_bmc (object, control_bmc);
|
| 184 | g_object_unref (control_bmc);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 185 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 186 | Control* control = control_skeleton_new ();
|
| 187 | object_skeleton_set_control (object, control);
|
| 188 | g_object_unref (control);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 189 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 190 | //define method callbacks here
|
| 191 | g_signal_connect (control,
|
| 192 | "handle-init",
|
| 193 | G_CALLBACK (on_init),
|
| 194 | NULL); /* user_data */
|
| 195 |
|
| 196 | /* Export the object (@manager takes its own reference to @object) */
|
| 197 | g_dbus_object_manager_server_export (manager, G_DBUS_OBJECT_SKELETON (object));
|
| 198 | g_object_unref (object);
|
| 199 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 200 | /* Export all objects */
|
| 201 | g_dbus_object_manager_server_set_connection (manager, connection);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 202 |
|
| 203 | //TODO: This is a bad hack to wait for object to be on bus
|
| 204 | //sleep(1);
|
| 205 | cmd->user_data = object;
|
| 206 | g_idle_add(go,cmd);
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 207 | }
|
| 208 |
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 209 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 210 | static void
|
| 211 | on_name_acquired (GDBusConnection *connection,
|
| 212 | const gchar *name,
|
| 213 | gpointer user_data)
|
| 214 | {
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 215 |
|
| 216 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 217 | }
|
| 218 |
|
| 219 | static void
|
| 220 | on_name_lost (GDBusConnection *connection,
|
| 221 | const gchar *name,
|
| 222 | gpointer user_data)
|
| 223 | {
|
| 224 | }
|
| 225 |
|
| 226 |
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 227 | /*----------------------------------------------------------------*/
|
| 228 | /* Main Event Loop */
|
| 229 |
|
| 230 | gint
|
| 231 | main (gint argc, gchar *argv[])
|
| 232 | {
|
| 233 | GMainLoop *loop;
|
| 234 | cmdline cmd;
|
| 235 | cmd.argc = argc;
|
| 236 | cmd.argv = argv;
|
| 237 |
|
| 238 | guint id;
|
| 239 | loop = g_main_loop_new (NULL, FALSE);
|
Norman James | 978d2f3 | 2015-10-28 12:45:52 -0500 | [diff] [blame] | 240 | cmd.loop = loop;
|
Norman James | e56d838 | 2015-10-22 14:35:04 -0500 | [diff] [blame] | 241 |
|
| 242 | id = g_bus_own_name (DBUS_TYPE,
|
| 243 | dbus_name,
|
| 244 | G_BUS_NAME_OWNER_FLAGS_ALLOW_REPLACEMENT |
|
| 245 | G_BUS_NAME_OWNER_FLAGS_REPLACE,
|
| 246 | on_bus_acquired,
|
| 247 | on_name_acquired,
|
| 248 | on_name_lost,
|
| 249 | &cmd,
|
| 250 | NULL);
|
| 251 |
|
| 252 | g_main_loop_run (loop);
|
| 253 |
|
| 254 | g_bus_unown_name (id);
|
| 255 | g_main_loop_unref (loop);
|
| 256 | return 0;
|
| 257 | }
|