Lines Matching refs:sm
133 static void sm501_dump_clk(struct sm501_devdata *sm)
135 unsigned long misct = smc501_readl(sm->regs + SM501_MISC_TIMING);
136 unsigned long pm0 = smc501_readl(sm->regs + SM501_POWER_MODE_0_CLOCK);
137 unsigned long pm1 = smc501_readl(sm->regs + SM501_POWER_MODE_1_CLOCK);
138 unsigned long pmc = smc501_readl(sm->regs + SM501_POWER_MODE_CONTROL);
163 dev_dbg(sm->dev, "MISCT=%08lx, PM0=%08lx, PM1=%08lx\n",
166 dev_dbg(sm->dev, "PLL2 = %ld.%ld MHz (%ld), SDCLK0=%08lx, SDCLK1=%08lx\n",
169 dev_dbg(sm->dev, "SDRAM: PM0=%ld, PM1=%ld\n", sdclk0, sdclk1);
171 dev_dbg(sm->dev, "PM0[%c]: "
180 dev_dbg(sm->dev, "PM1[%c]: "
190 static void sm501_dump_regs(struct sm501_devdata *sm)
192 void __iomem *regs = sm->regs;
194 dev_info(sm->dev, "System Control %08x\n",
196 dev_info(sm->dev, "Misc Control %08x\n",
198 dev_info(sm->dev, "GPIO Control Low %08x\n",
200 dev_info(sm->dev, "GPIO Control Hi %08x\n",
202 dev_info(sm->dev, "DRAM Control %08x\n",
204 dev_info(sm->dev, "Arbitration Ctrl %08x\n",
206 dev_info(sm->dev, "Misc Timing %08x\n",
210 static void sm501_dump_gate(struct sm501_devdata *sm)
212 dev_info(sm->dev, "CurrentGate %08x\n",
213 smc501_readl(sm->regs + SM501_CURRENT_GATE));
214 dev_info(sm->dev, "CurrentClock %08x\n",
215 smc501_readl(sm->regs + SM501_CURRENT_CLOCK));
216 dev_info(sm->dev, "PowerModeControl %08x\n",
217 smc501_readl(sm->regs + SM501_POWER_MODE_CONTROL));
221 static inline void sm501_dump_gate(struct sm501_devdata *sm) { }
222 static inline void sm501_dump_regs(struct sm501_devdata *sm) { }
223 static inline void sm501_dump_clk(struct sm501_devdata *sm) { }
231 static void sm501_sync_regs(struct sm501_devdata *sm)
233 smc501_readl(sm->regs);
236 static inline void sm501_mdelay(struct sm501_devdata *sm, unsigned int delay)
242 if (sm->in_suspend)
256 struct sm501_devdata *sm = dev_get_drvdata(dev);
261 spin_lock_irqsave(&sm->reg_lock, save);
263 misc = smc501_readl(sm->regs + SM501_MISC_CONTROL);
267 smc501_writel(to, sm->regs + SM501_MISC_CONTROL);
268 sm501_sync_regs(sm);
270 dev_dbg(sm->dev, "MISC_CONTROL %08lx\n", misc);
273 spin_unlock_irqrestore(&sm->reg_lock, save);
290 struct sm501_devdata *sm = dev_get_drvdata(dev);
294 spin_lock_irqsave(&sm->reg_lock, save);
296 data = smc501_readl(sm->regs + reg);
300 smc501_writel(data, sm->regs + reg);
301 sm501_sync_regs(sm);
303 spin_unlock_irqrestore(&sm->reg_lock, save);
317 struct sm501_devdata *sm = dev_get_drvdata(dev);
322 mutex_lock(&sm->clock_lock);
324 mode = smc501_readl(sm->regs + SM501_POWER_MODE_CONTROL);
325 gate = smc501_readl(sm->regs + SM501_CURRENT_GATE);
326 clock = smc501_readl(sm->regs + SM501_CURRENT_CLOCK);
330 if (unit >= ARRAY_SIZE(sm->unit_power)) {
335 dev_dbg(sm->dev, "%s: unit %d, cur %d, to %d\n", __func__, unit,
336 sm->unit_power[unit], to);
338 if (to == 0 && sm->unit_power[unit] == 0) {
339 dev_err(sm->dev, "unit %d is already shutdown\n", unit);
343 sm->unit_power[unit] += to ? 1 : -1;
344 to = sm->unit_power[unit] ? 1 : 0;
358 smc501_writel(gate, sm->regs + SM501_POWER_MODE_0_GATE);
359 smc501_writel(clock, sm->regs + SM501_POWER_MODE_0_CLOCK);
364 smc501_writel(gate, sm->regs + SM501_POWER_MODE_1_GATE);
365 smc501_writel(clock, sm->regs + SM501_POWER_MODE_1_CLOCK);
374 smc501_writel(mode, sm->regs + SM501_POWER_MODE_CONTROL);
375 sm501_sync_regs(sm);
377 dev_dbg(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
380 sm501_mdelay(sm, 16);
383 mutex_unlock(&sm->clock_lock);
512 struct sm501_devdata *sm = dev_get_drvdata(dev);
513 unsigned long mode = smc501_readl(sm->regs + SM501_POWER_MODE_CONTROL);
514 unsigned long gate = smc501_readl(sm->regs + SM501_CURRENT_GATE);
515 unsigned long clock = smc501_readl(sm->regs + SM501_CURRENT_CLOCK);
532 if (sm->rev >= 0xC0) {
584 mutex_lock(&sm->clock_lock);
586 mode = smc501_readl(sm->regs + SM501_POWER_MODE_CONTROL);
587 gate = smc501_readl(sm->regs + SM501_CURRENT_GATE);
588 clock = smc501_readl(sm->regs + SM501_CURRENT_CLOCK);
597 smc501_writel(gate, sm->regs + SM501_POWER_MODE_0_GATE);
598 smc501_writel(clock, sm->regs + SM501_POWER_MODE_0_CLOCK);
603 smc501_writel(gate, sm->regs + SM501_POWER_MODE_1_GATE);
604 smc501_writel(clock, sm->regs + SM501_POWER_MODE_1_CLOCK);
609 mutex_unlock(&sm->clock_lock);
613 smc501_writel(mode, sm->regs + SM501_POWER_MODE_CONTROL);
617 sm->regs + SM501_PROGRAMMABLE_PLL_CONTROL);
619 sm501_sync_regs(sm);
621 dev_dbg(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
624 sm501_mdelay(sm, 16);
625 mutex_unlock(&sm->clock_lock);
627 sm501_dump_clk(sm);
643 struct sm501_devdata *sm = dev_get_drvdata(dev);
649 if (sm->rev >= 0xC0) {
700 sm501_create_subdev(struct sm501_devdata *sm, char *name,
714 smdev->pdev.id = sm->pdev_id;
715 smdev->pdev.dev.parent = sm->dev;
733 static int sm501_register_device(struct sm501_devdata *sm,
748 dev_dbg(sm->dev, "registered %s\n", pdev->name);
749 list_add_tail(&smdev->list, &sm->devices);
751 dev_err(sm->dev, "error registering %s (%d)\n",
762 static void sm501_create_subio(struct sm501_devdata *sm,
768 res->parent = sm->io_res;
769 res->start = sm->io_res->start + offs;
778 static void sm501_create_mem(struct sm501_devdata *sm,
786 res->parent = sm->mem_res;
787 res->start = sm->mem_res->start + *offs;
796 static void sm501_create_irq(struct sm501_devdata *sm,
801 res->start = res->end = sm->irq;
804 static int sm501_register_usbhost(struct sm501_devdata *sm,
809 pdev = sm501_create_subdev(sm, "sm501-usb", 3, 0);
813 sm501_create_subio(sm, &pdev->resource[0], 0x40000, 0x20000);
814 sm501_create_mem(sm, &pdev->resource[1], mem_avail, 256*1024);
815 sm501_create_irq(sm, &pdev->resource[2]);
817 return sm501_register_device(sm, pdev);
820 static void sm501_setup_uart_data(struct sm501_devdata *sm,
824 uart_data->membase = sm->regs + offset;
825 uart_data->mapbase = sm->io_res->start + offset;
827 uart_data->irq = sm->irq;
833 static int sm501_register_uart(struct sm501_devdata *sm, int devices)
838 pdev = sm501_create_subdev(sm, "serial8250", 0,
846 sm501_setup_uart_data(sm, uart_data++, 0x30000);
847 sm501_unit_power(sm->dev, SM501_GATE_UART0, 1);
848 sm501_modify_reg(sm->dev, SM501_IRQ_MASK, 1 << 12, 0);
849 sm501_modify_reg(sm->dev, SM501_GPIO63_32_CONTROL, 0x01e0, 0);
852 sm501_setup_uart_data(sm, uart_data++, 0x30020);
853 sm501_unit_power(sm->dev, SM501_GATE_UART1, 1);
854 sm501_modify_reg(sm->dev, SM501_IRQ_MASK, 1 << 13, 0);
855 sm501_modify_reg(sm->dev, SM501_GPIO63_32_CONTROL, 0x1e00, 0);
860 return sm501_register_device(sm, pdev);
863 static int sm501_register_display(struct sm501_devdata *sm,
868 pdev = sm501_create_subdev(sm, "sm501-fb", 4, 0);
872 sm501_create_subio(sm, &pdev->resource[0], 0x80000, 0x10000);
873 sm501_create_subio(sm, &pdev->resource[1], 0x100000, 0x50000);
874 sm501_create_mem(sm, &pdev->resource[2], mem_avail, *mem_avail);
875 sm501_create_irq(sm, &pdev->resource[3]);
877 return sm501_register_device(sm, pdev);
1012 static int sm501_gpio_register_chip(struct sm501_devdata *sm,
1016 struct sm501_platdata *pdata = sm->platdata;
1026 chip->control = sm->regs + SM501_GPIO63_32_CONTROL;
1030 chip->control = sm->regs + SM501_GPIO31_0_CONTROL;
1040 static int sm501_register_gpio(struct sm501_devdata *sm)
1042 struct sm501_gpio *gpio = &sm->gpio;
1043 resource_size_t iobase = sm->io_res->start + SM501_GPIO;
1046 dev_dbg(sm->dev, "registering gpio block %08llx\n",
1053 dev_err(sm->dev, "gpio: failed to request region\n");
1059 dev_err(sm->dev, "gpio: failed to remap registers\n");
1066 ret = sm501_gpio_register_chip(sm, gpio, &gpio->low);
1068 dev_err(sm->dev, "failed to add low chip\n");
1072 ret = sm501_gpio_register_chip(sm, gpio, &gpio->high);
1074 dev_err(sm->dev, "failed to add high chip\n");
1094 static void sm501_gpio_remove(struct sm501_devdata *sm)
1096 struct sm501_gpio *gpio = &sm->gpio;
1097 resource_size_t iobase = sm->io_res->start + SM501_GPIO;
1099 if (!sm->gpio.registered)
1109 static inline int sm501_gpio_isregistered(struct sm501_devdata *sm)
1111 return sm->gpio.registered;
1114 static inline int sm501_register_gpio(struct sm501_devdata *sm)
1119 static inline void sm501_gpio_remove(struct sm501_devdata *sm)
1123 static inline int sm501_gpio_isregistered(struct sm501_devdata *sm)
1129 static int sm501_register_gpio_i2c_instance(struct sm501_devdata *sm,
1136 pdev = sm501_create_subdev(sm, "i2c-gpio", 0,
1170 dev_info(sm->dev, "registering i2c-%d: sda=%d, scl=%d\n",
1174 return sm501_register_device(sm, pdev);
1177 static int sm501_register_gpio_i2c(struct sm501_devdata *sm,
1185 ret = sm501_register_gpio_i2c_instance(sm, iic);
1201 struct sm501_devdata *sm = dev_get_drvdata(dev) ;
1208 reg, smc501_readl(sm->regs + reg));
1226 static inline void sm501_init_reg(struct sm501_devdata *sm,
1232 tmp = smc501_readl(sm->regs + reg);
1235 smc501_writel(tmp, sm->regs + reg);
1243 static void sm501_init_regs(struct sm501_devdata *sm,
1246 sm501_misc_control(sm->dev,
1250 sm501_init_reg(sm, SM501_MISC_TIMING, &init->misc_timing);
1251 sm501_init_reg(sm, SM501_GPIO31_0_CONTROL, &init->gpio_low);
1252 sm501_init_reg(sm, SM501_GPIO63_32_CONTROL, &init->gpio_high);
1255 dev_info(sm->dev, "setting M1XCLK to %ld\n", init->m1xclk);
1256 sm501_set_clock(sm->dev, SM501_CLOCK_M1XCLK, init->m1xclk);
1260 dev_info(sm->dev, "setting MCLK to %ld\n", init->mclk);
1261 sm501_set_clock(sm->dev, SM501_CLOCK_MCLK, init->mclk);
1274 static int sm501_check_clocks(struct sm501_devdata *sm)
1276 unsigned long pwrmode = smc501_readl(sm->regs + SM501_CURRENT_CLOCK);
1297 static int sm501_init_dev(struct sm501_devdata *sm)
1306 mutex_init(&sm->clock_lock);
1307 spin_lock_init(&sm->reg_lock);
1309 INIT_LIST_HEAD(&sm->devices);
1311 devid = smc501_readl(sm->regs + SM501_DEVICEID);
1314 dev_err(sm->dev, "incorrect device id %08lx\n", devid);
1319 smc501_writel(0, sm->regs + SM501_IRQ_MASK);
1321 dramctrl = smc501_readl(sm->regs + SM501_DRAM_CONTROL);
1324 dev_info(sm->dev, "SM501 At %p: Version %08lx, %ld Mb, IRQ %d\n",
1325 sm->regs, devid, (unsigned long)mem_avail >> 20, sm->irq);
1327 sm->rev = devid & SM501_DEVICEID_REVMASK;
1329 sm501_dump_gate(sm);
1331 ret = device_create_file(sm->dev, &dev_attr_dbg_regs);
1333 dev_err(sm->dev, "failed to create debug regs file\n");
1335 sm501_dump_clk(sm);
1339 pdata = sm->platdata;
1343 sm501_init_regs(sm, idata);
1346 sm501_register_usbhost(sm, &mem_avail);
1348 sm501_register_uart(sm, idata->devices);
1350 sm501_register_gpio(sm);
1354 if (!sm501_gpio_isregistered(sm))
1355 dev_err(sm->dev, "no gpio available for i2c gpio.\n");
1357 sm501_register_gpio_i2c(sm, pdata);
1360 ret = sm501_check_clocks(sm);
1362 dev_err(sm->dev, "M1X and M clocks sourced from different "
1368 sm501_register_display(sm, &mem_avail);
1375 struct sm501_devdata *sm;
1378 sm = kzalloc(sizeof(*sm), GFP_KERNEL);
1379 if (!sm) {
1384 sm->dev = &dev->dev;
1385 sm->pdev_id = dev->id;
1386 sm->platdata = dev_get_platdata(&dev->dev);
1391 sm->irq = ret;
1393 sm->io_res = platform_get_resource(dev, IORESOURCE_MEM, 1);
1394 sm->mem_res = platform_get_resource(dev, IORESOURCE_MEM, 0);
1395 if (!sm->io_res || !sm->mem_res) {
1401 sm->regs_claim = request_mem_region(sm->io_res->start,
1403 if (!sm->regs_claim) {
1409 platform_set_drvdata(dev, sm);
1411 sm->regs = ioremap(sm->io_res->start, resource_size(sm->io_res));
1412 if (!sm->regs) {
1418 ret = sm501_init_dev(sm);
1425 iounmap(sm->regs);
1427 release_mem_region(sm->io_res->start, 0x100);
1429 kfree(sm);
1437 static void sm501_set_power(struct sm501_devdata *sm, int on)
1439 struct sm501_platdata *pd = sm->platdata;
1445 if (pd->get_power(sm->dev) == on) {
1446 dev_dbg(sm->dev, "is already %d\n", on);
1452 dev_dbg(sm->dev, "setting power to %d\n", on);
1454 pd->set_power(sm->dev, on);
1455 sm501_mdelay(sm, 10);
1461 struct sm501_devdata *sm = platform_get_drvdata(pdev);
1463 sm->in_suspend = 1;
1464 sm->pm_misc = smc501_readl(sm->regs + SM501_MISC_CONTROL);
1466 sm501_dump_regs(sm);
1468 if (sm->platdata) {
1469 if (sm->platdata->flags & SM501_FLAG_SUSPEND_OFF)
1470 sm501_set_power(sm, 0);
1478 struct sm501_devdata *sm = platform_get_drvdata(pdev);
1480 sm501_set_power(sm, 1);
1482 sm501_dump_regs(sm);
1483 sm501_dump_gate(sm);
1484 sm501_dump_clk(sm);
1488 if (smc501_readl(sm->regs + SM501_MISC_CONTROL) != sm->pm_misc) {
1489 dev_info(sm->dev, "SM501_MISC_CONTROL changed over sleep\n");
1490 smc501_writel(sm->pm_misc, sm->regs + SM501_MISC_CONTROL);
1496 if (sm->platdata && sm->platdata->init) {
1497 sm501_init_regs(sm, sm->platdata->init);
1503 sm501_dump_regs(sm);
1504 sm501_dump_clk(sm);
1506 sm->in_suspend = 0;
1558 struct sm501_devdata *sm;
1561 sm = kzalloc(sizeof(*sm), GFP_KERNEL);
1562 if (!sm) {
1568 dev->dev.platform_data = sm->platdata = &sm501_pci_platdata;
1571 sm->pdev_id = 32 + dev->devfn;
1573 pci_set_drvdata(dev, sm);
1581 sm->dev = &dev->dev;
1582 sm->irq = dev->irq;
1608 sm->io_res = &dev->resource[1];
1609 sm->mem_res = &dev->resource[0];
1611 sm->regs_claim = request_mem_region(sm->io_res->start,
1613 if (!sm->regs_claim) {
1619 sm->regs = pci_ioremap_bar(dev, 1);
1620 if (!sm->regs) {
1626 sm501_init_dev(sm);
1630 release_mem_region(sm->io_res->start, 0x100);
1634 kfree(sm);
1639 static void sm501_remove_sub(struct sm501_devdata *sm,
1646 static void sm501_dev_remove(struct sm501_devdata *sm)
1650 list_for_each_entry_safe(smdev, tmp, &sm->devices, list)
1651 sm501_remove_sub(sm, smdev);
1653 device_remove_file(sm->dev, &dev_attr_dbg_regs);
1655 sm501_gpio_remove(sm);
1660 struct sm501_devdata *sm = pci_get_drvdata(dev);
1662 sm501_dev_remove(sm);
1663 iounmap(sm->regs);
1665 release_mem_region(sm->io_res->start, 0x100);
1672 struct sm501_devdata *sm = platform_get_drvdata(dev);
1674 sm501_dev_remove(sm);
1675 iounmap(sm->regs);
1677 release_mem_region(sm->io_res->start, 0x100);