Lines Matching defs:sm
134 static void sm501_dump_clk(struct sm501_devdata *sm)
136 unsigned long misct = readl(sm->regs + SM501_MISC_TIMING);
137 unsigned long pm0 = readl(sm->regs + SM501_POWER_MODE_0_CLOCK);
138 unsigned long pm1 = readl(sm->regs + SM501_POWER_MODE_1_CLOCK);
139 unsigned long pmc = readl(sm->regs + SM501_POWER_MODE_CONTROL);
164 dev_dbg(sm->dev, "MISCT=%08lx, PM0=%08lx, PM1=%08lx\n",
167 dev_dbg(sm->dev, "PLL2 = %ld.%ld MHz (%ld), SDCLK0=%08lx, SDCLK1=%08lx\n",
170 dev_dbg(sm->dev, "SDRAM: PM0=%ld, PM1=%ld\n", sdclk0, sdclk1);
172 dev_dbg(sm->dev, "PM0[%c]: "
181 dev_dbg(sm->dev, "PM1[%c]: "
191 static void sm501_dump_regs(struct sm501_devdata *sm)
193 void __iomem *regs = sm->regs;
195 dev_info(sm->dev, "System Control %08x\n",
197 dev_info(sm->dev, "Misc Control %08x\n",
199 dev_info(sm->dev, "GPIO Control Low %08x\n",
201 dev_info(sm->dev, "GPIO Control Hi %08x\n",
203 dev_info(sm->dev, "DRAM Control %08x\n",
205 dev_info(sm->dev, "Arbitration Ctrl %08x\n",
207 dev_info(sm->dev, "Misc Timing %08x\n",
211 static void sm501_dump_gate(struct sm501_devdata *sm)
213 dev_info(sm->dev, "CurrentGate %08x\n",
214 readl(sm->regs + SM501_CURRENT_GATE));
215 dev_info(sm->dev, "CurrentClock %08x\n",
216 readl(sm->regs + SM501_CURRENT_CLOCK));
217 dev_info(sm->dev, "PowerModeControl %08x\n",
218 readl(sm->regs + SM501_POWER_MODE_CONTROL));
222 static inline void sm501_dump_gate(struct sm501_devdata *sm) { }
223 static inline void sm501_dump_regs(struct sm501_devdata *sm) { }
224 static inline void sm501_dump_clk(struct sm501_devdata *sm) { }
232 static void sm501_sync_regs(struct sm501_devdata *sm)
234 readl(sm->regs);
237 static inline void sm501_mdelay(struct sm501_devdata *sm, unsigned int delay)
243 if (sm->in_suspend)
257 struct sm501_devdata *sm = dev_get_drvdata(dev);
262 spin_lock_irqsave(&sm->reg_lock, save);
264 misc = readl(sm->regs + SM501_MISC_CONTROL);
268 writel(to, sm->regs + SM501_MISC_CONTROL);
269 sm501_sync_regs(sm);
271 dev_dbg(sm->dev, "MISC_CONTROL %08lx\n", misc);
274 spin_unlock_irqrestore(&sm->reg_lock, save);
291 struct sm501_devdata *sm = dev_get_drvdata(dev);
295 spin_lock_irqsave(&sm->reg_lock, save);
297 data = readl(sm->regs + reg);
301 writel(data, sm->regs + reg);
302 sm501_sync_regs(sm);
304 spin_unlock_irqrestore(&sm->reg_lock, save);
318 struct sm501_devdata *sm = dev_get_drvdata(dev);
323 mutex_lock(&sm->clock_lock);
325 mode = readl(sm->regs + SM501_POWER_MODE_CONTROL);
326 gate = readl(sm->regs + SM501_CURRENT_GATE);
327 clock = readl(sm->regs + SM501_CURRENT_CLOCK);
331 if (unit >= ARRAY_SIZE(sm->unit_power)) {
336 dev_dbg(sm->dev, "%s: unit %d, cur %d, to %d\n", __func__, unit,
337 sm->unit_power[unit], to);
339 if (to == 0 && sm->unit_power[unit] == 0) {
340 dev_err(sm->dev, "unit %d is already shutdown\n", unit);
344 sm->unit_power[unit] += to ? 1 : -1;
345 to = sm->unit_power[unit] ? 1 : 0;
359 writel(gate, sm->regs + SM501_POWER_MODE_0_GATE);
360 writel(clock, sm->regs + SM501_POWER_MODE_0_CLOCK);
365 writel(gate, sm->regs + SM501_POWER_MODE_1_GATE);
366 writel(clock, sm->regs + SM501_POWER_MODE_1_CLOCK);
375 writel(mode, sm->regs + SM501_POWER_MODE_CONTROL);
376 sm501_sync_regs(sm);
378 dev_dbg(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
381 sm501_mdelay(sm, 16);
384 mutex_unlock(&sm->clock_lock);
521 struct sm501_devdata *sm = dev_get_drvdata(dev);
522 unsigned long mode = readl(sm->regs + SM501_POWER_MODE_CONTROL);
523 unsigned long gate = readl(sm->regs + SM501_CURRENT_GATE);
524 unsigned long clock = readl(sm->regs + SM501_CURRENT_CLOCK);
541 if (sm->rev >= 0xC0) {
593 mutex_lock(&sm->clock_lock);
595 mode = readl(sm->regs + SM501_POWER_MODE_CONTROL);
596 gate = readl(sm->regs + SM501_CURRENT_GATE);
597 clock = readl(sm->regs + SM501_CURRENT_CLOCK);
606 writel(gate, sm->regs + SM501_POWER_MODE_0_GATE);
607 writel(clock, sm->regs + SM501_POWER_MODE_0_CLOCK);
612 writel(gate, sm->regs + SM501_POWER_MODE_1_GATE);
613 writel(clock, sm->regs + SM501_POWER_MODE_1_CLOCK);
618 mutex_unlock(&sm->clock_lock);
622 writel(mode, sm->regs + SM501_POWER_MODE_CONTROL);
625 writel(pll_reg, sm->regs + SM501_PROGRAMMABLE_PLL_CONTROL);
627 sm501_sync_regs(sm);
629 dev_dbg(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
632 sm501_mdelay(sm, 16);
633 mutex_unlock(&sm->clock_lock);
635 sm501_dump_clk(sm);
651 struct sm501_devdata *sm = dev_get_drvdata(dev);
657 if (sm->rev >= 0xC0) {
708 sm501_create_subdev(struct sm501_devdata *sm, char *name,
722 smdev->pdev.id = sm->pdev_id;
723 smdev->pdev.dev.parent = sm->dev;
740 static int sm501_register_device(struct sm501_devdata *sm,
758 dev_dbg(sm->dev, "registered %s\n", pdev->name);
759 list_add_tail(&smdev->list, &sm->devices);
761 dev_err(sm->dev, "error registering %s (%d)\n",
772 static void sm501_create_subio(struct sm501_devdata *sm,
778 res->parent = sm->io_res;
779 res->start = sm->io_res->start + offs;
788 static void sm501_create_mem(struct sm501_devdata *sm,
796 res->parent = sm->mem_res;
797 res->start = sm->mem_res->start + *offs;
806 static void sm501_create_irq(struct sm501_devdata *sm,
811 res->start = res->end = sm->irq;
814 static int sm501_register_usbhost(struct sm501_devdata *sm,
819 pdev = sm501_create_subdev(sm, "sm501-usb", 3, 0);
823 sm501_create_subio(sm, &pdev->resource[0], 0x40000, 0x20000);
824 sm501_create_mem(sm, &pdev->resource[1], mem_avail, 256*1024);
825 sm501_create_irq(sm, &pdev->resource[2]);
827 return sm501_register_device(sm, pdev);
830 static void sm501_setup_uart_data(struct sm501_devdata *sm,
834 uart_data->membase = sm->regs + offset;
835 uart_data->mapbase = sm->io_res->start + offset;
837 uart_data->irq = sm->irq;
843 static int sm501_register_uart(struct sm501_devdata *sm, int devices)
848 pdev = sm501_create_subdev(sm, "serial8250", 0,
856 sm501_setup_uart_data(sm, uart_data++, 0x30000);
857 sm501_unit_power(sm->dev, SM501_GATE_UART0, 1);
858 sm501_modify_reg(sm->dev, SM501_IRQ_MASK, 1 << 12, 0);
859 sm501_modify_reg(sm->dev, SM501_GPIO63_32_CONTROL, 0x01e0, 0);
862 sm501_setup_uart_data(sm, uart_data++, 0x30020);
863 sm501_unit_power(sm->dev, SM501_GATE_UART1, 1);
864 sm501_modify_reg(sm->dev, SM501_IRQ_MASK, 1 << 13, 0);
865 sm501_modify_reg(sm->dev, SM501_GPIO63_32_CONTROL, 0x1e00, 0);
870 return sm501_register_device(sm, pdev);
873 static int sm501_register_display(struct sm501_devdata *sm,
878 pdev = sm501_create_subdev(sm, "sm501-fb", 4, 0);
882 sm501_create_subio(sm, &pdev->resource[0], 0x80000, 0x10000);
883 sm501_create_subio(sm, &pdev->resource[1], 0x100000, 0x50000);
884 sm501_create_mem(sm, &pdev->resource[2], mem_avail, *mem_avail);
885 sm501_create_irq(sm, &pdev->resource[3]);
887 return sm501_register_device(sm, pdev);
1027 static int __devinit sm501_gpio_register_chip(struct sm501_devdata *sm,
1031 struct sm501_platdata *pdata = sm->platdata;
1041 chip->control = sm->regs + SM501_GPIO63_32_CONTROL;
1045 chip->control = sm->regs + SM501_GPIO31_0_CONTROL;
1055 static int __devinit sm501_register_gpio(struct sm501_devdata *sm)
1057 struct sm501_gpio *gpio = &sm->gpio;
1058 resource_size_t iobase = sm->io_res->start + SM501_GPIO;
1062 dev_dbg(sm->dev, "registering gpio block %08llx\n",
1069 dev_err(sm->dev, "gpio: failed to request region\n");
1075 dev_err(sm->dev, "gpio: failed to remap registers\n");
1082 ret = sm501_gpio_register_chip(sm, gpio, &gpio->low);
1084 dev_err(sm->dev, "failed to add low chip\n");
1088 ret = sm501_gpio_register_chip(sm, gpio, &gpio->high);
1090 dev_err(sm->dev, "failed to add high chip\n");
1101 dev_err(sm->dev, "cannot remove low chip, cannot tidy up\n");
1115 static void sm501_gpio_remove(struct sm501_devdata *sm)
1117 struct sm501_gpio *gpio = &sm->gpio;
1120 if (!sm->gpio.registered)
1125 dev_err(sm->dev, "cannot remove low chip, cannot tidy up\n");
1129 dev_err(sm->dev, "cannot remove high chip, cannot tidy up\n");
1136 static inline int sm501_gpio_pin2nr(struct sm501_devdata *sm, unsigned int pin)
1138 struct sm501_gpio *gpio = &sm->gpio;
1144 static inline int sm501_gpio_isregistered(struct sm501_devdata *sm)
1146 return sm->gpio.registered;
1149 static inline int sm501_register_gpio(struct sm501_devdata *sm)
1154 static inline void sm501_gpio_remove(struct sm501_devdata *sm)
1158 static inline int sm501_gpio_pin2nr(struct sm501_devdata *sm, unsigned int pin)
1163 static inline int sm501_gpio_isregistered(struct sm501_devdata *sm)
1169 static int sm501_register_gpio_i2c_instance(struct sm501_devdata *sm,
1175 pdev = sm501_create_subdev(sm, "i2c-gpio", 0,
1186 icd->sda_pin = sm501_gpio_pin2nr(sm, iic->pin_sda);
1187 icd->scl_pin = sm501_gpio_pin2nr(sm, iic->pin_scl);
1199 dev_info(sm->dev, "registering i2c-%d: sda=%d (%d), scl=%d (%d)\n",
1203 return sm501_register_device(sm, pdev);
1206 static int sm501_register_gpio_i2c(struct sm501_devdata *sm,
1214 ret = sm501_register_gpio_i2c_instance(sm, iic);
1230 struct sm501_devdata *sm = dev_get_drvdata(dev) ;
1237 reg, readl(sm->regs + reg));
1255 static inline void sm501_init_reg(struct sm501_devdata *sm,
1261 tmp = readl(sm->regs + reg);
1264 writel(tmp, sm->regs + reg);
1272 static void sm501_init_regs(struct sm501_devdata *sm,
1275 sm501_misc_control(sm->dev,
1279 sm501_init_reg(sm, SM501_MISC_TIMING, &init->misc_timing);
1280 sm501_init_reg(sm, SM501_GPIO31_0_CONTROL, &init->gpio_low);
1281 sm501_init_reg(sm, SM501_GPIO63_32_CONTROL, &init->gpio_high);
1284 dev_info(sm->dev, "setting M1XCLK to %ld\n", init->m1xclk);
1285 sm501_set_clock(sm->dev, SM501_CLOCK_M1XCLK, init->m1xclk);
1289 dev_info(sm->dev, "setting MCLK to %ld\n", init->mclk);
1290 sm501_set_clock(sm->dev, SM501_CLOCK_MCLK, init->mclk);
1303 static int sm501_check_clocks(struct sm501_devdata *sm)
1305 unsigned long pwrmode = readl(sm->regs + SM501_CURRENT_CLOCK);
1326 static int __devinit sm501_init_dev(struct sm501_devdata *sm)
1335 mutex_init(&sm->clock_lock);
1336 spin_lock_init(&sm->reg_lock);
1338 INIT_LIST_HEAD(&sm->devices);
1340 devid = readl(sm->regs + SM501_DEVICEID);
1343 dev_err(sm->dev, "incorrect device id %08lx\n", devid);
1348 writel(0, sm->regs + SM501_IRQ_MASK);
1350 dramctrl = readl(sm->regs + SM501_DRAM_CONTROL);
1353 dev_info(sm->dev, "SM501 At %p: Version %08lx, %ld Mb, IRQ %d\n",
1354 sm->regs, devid, (unsigned long)mem_avail >> 20, sm->irq);
1356 sm->rev = devid & SM501_DEVICEID_REVMASK;
1358 sm501_dump_gate(sm);
1360 ret = device_create_file(sm->dev, &dev_attr_dbg_regs);
1362 dev_err(sm->dev, "failed to create debug regs file\n");
1364 sm501_dump_clk(sm);
1368 pdata = sm->platdata;
1372 sm501_init_regs(sm, idata);
1375 sm501_register_usbhost(sm, &mem_avail);
1377 sm501_register_uart(sm, idata->devices);
1379 sm501_register_gpio(sm);
1383 if (!sm501_gpio_isregistered(sm))
1384 dev_err(sm->dev, "no gpio available for i2c gpio.\n");
1386 sm501_register_gpio_i2c(sm, pdata);
1389 ret = sm501_check_clocks(sm);
1391 dev_err(sm->dev, "M1X and M clocks sourced from different "
1397 sm501_register_display(sm, &mem_avail);
1404 struct sm501_devdata *sm;
1407 sm = kzalloc(sizeof(struct sm501_devdata), GFP_KERNEL);
1408 if (sm == NULL) {
1414 sm->dev = &dev->dev;
1415 sm->pdev_id = dev->id;
1416 sm->platdata = dev->dev.platform_data;
1423 sm->irq = ret;
1425 sm->io_res = platform_get_resource(dev, IORESOURCE_MEM, 1);
1426 sm->mem_res = platform_get_resource(dev, IORESOURCE_MEM, 0);
1427 if (sm->io_res == NULL || sm->mem_res == NULL) {
1433 sm->regs_claim = request_mem_region(sm->io_res->start,
1436 if (sm->regs_claim == NULL) {
1442 platform_set_drvdata(dev, sm);
1444 sm->regs = ioremap(sm->io_res->start, resource_size(sm->io_res));
1446 if (sm->regs == NULL) {
1452 return sm501_init_dev(sm);
1455 release_resource(sm->regs_claim);
1456 kfree(sm->regs_claim);
1458 kfree(sm);
1468 static void sm501_set_power(struct sm501_devdata *sm, int on)
1470 struct sm501_platdata *pd = sm->platdata;
1476 if (pd->get_power(sm->dev) == on) {
1477 dev_dbg(sm->dev, "is already %d\n", on);
1483 dev_dbg(sm->dev, "setting power to %d\n", on);
1485 pd->set_power(sm->dev, on);
1486 sm501_mdelay(sm, 10);
1492 struct sm501_devdata *sm = platform_get_drvdata(pdev);
1494 sm->in_suspend = 1;
1495 sm->pm_misc = readl(sm->regs + SM501_MISC_CONTROL);
1497 sm501_dump_regs(sm);
1499 if (sm->platdata) {
1500 if (sm->platdata->flags & SM501_FLAG_SUSPEND_OFF)
1501 sm501_set_power(sm, 0);
1509 struct sm501_devdata *sm = platform_get_drvdata(pdev);
1511 sm501_set_power(sm, 1);
1513 sm501_dump_regs(sm);
1514 sm501_dump_gate(sm);
1515 sm501_dump_clk(sm);
1519 if (readl(sm->regs + SM501_MISC_CONTROL) != sm->pm_misc) {
1520 dev_info(sm->dev, "SM501_MISC_CONTROL changed over sleep\n");
1521 writel(sm->pm_misc, sm->regs + SM501_MISC_CONTROL);
1527 if (sm->platdata && sm->platdata->init) {
1528 sm501_init_regs(sm, sm->platdata->init);
1534 sm501_dump_regs(sm);
1535 sm501_dump_clk(sm);
1537 sm->in_suspend = 0;
1593 struct sm501_devdata *sm;
1596 sm = kzalloc(sizeof(struct sm501_devdata), GFP_KERNEL);
1597 if (sm == NULL) {
1604 dev->dev.platform_data = sm->platdata = &sm501_pci_platdata;
1607 sm->pdev_id = 32 + dev->devfn;
1609 pci_set_drvdata(dev, sm);
1617 sm->dev = &dev->dev;
1618 sm->irq = dev->irq;
1644 sm->io_res = &dev->resource[1];
1645 sm->mem_res = &dev->resource[0];
1647 sm->regs_claim = request_mem_region(sm->io_res->start,
1649 if (sm->regs_claim == NULL) {
1655 sm->regs = pci_ioremap_bar(dev, 1);
1657 if (sm->regs == NULL) {
1663 sm501_init_dev(sm);
1667 release_resource(sm->regs_claim);
1668 kfree(sm->regs_claim);
1673 kfree(sm);
1678 static void sm501_remove_sub(struct sm501_devdata *sm,
1685 static void sm501_dev_remove(struct sm501_devdata *sm)
1689 list_for_each_entry_safe(smdev, tmp, &sm->devices, list)
1690 sm501_remove_sub(sm, smdev);
1692 device_remove_file(sm->dev, &dev_attr_dbg_regs);
1694 sm501_gpio_remove(sm);
1699 struct sm501_devdata *sm = pci_get_drvdata(dev);
1701 sm501_dev_remove(sm);
1702 iounmap(sm->regs);
1704 release_resource(sm->regs_claim);
1705 kfree(sm->regs_claim);
1713 struct sm501_devdata *sm = platform_get_drvdata(dev);
1715 sm501_dev_remove(sm);
1716 iounmap(sm->regs);
1718 release_resource(sm->regs_claim);
1719 kfree(sm->regs_claim);