Lines Matching +full:sdb +full:- +full:gpios
12 * - maybe add timeout to commands ?
13 * - blocking version of time functions
14 * - polling version of i2c commands (including timer that works with
16 * - maybe avoid some data copies with i2c by directly using the smu cmd
18 * - understand SMU -> CPU events and implement reception of them via
117 if (list_empty(&smu->cmd_list)) in smu_start_cmd()
121 cmd = list_entry(smu->cmd_list.next, struct smu_cmd, link); in smu_start_cmd()
122 smu->cmd_cur = cmd; in smu_start_cmd()
123 list_del(&cmd->link); in smu_start_cmd()
125 DPRINTK("SMU: starting cmd %x, %d bytes data\n", cmd->cmd, in smu_start_cmd()
126 cmd->data_len); in smu_start_cmd()
127 DPRINTK("SMU: data buffer: %8ph\n", cmd->data_buf); in smu_start_cmd()
130 smu->cmd_buf->cmd = cmd->cmd; in smu_start_cmd()
131 smu->cmd_buf->length = cmd->data_len; in smu_start_cmd()
132 memcpy(smu->cmd_buf->data, cmd->data_buf, cmd->data_len); in smu_start_cmd()
135 faddr = (unsigned long)smu->cmd_buf; in smu_start_cmd()
136 fend = faddr + smu->cmd_buf->length + 2; in smu_start_cmd()
149 if (smu->broken_nap) in smu_start_cmd()
156 writel(smu->cmd_buf_abs, smu->db_buf); in smu_start_cmd()
159 pmac_do_feature_call(PMAC_FTR_WRITE_GPIO, NULL, smu->doorbell, 4); in smu_start_cmd()
175 spin_lock_irqsave(&smu->lock, flags); in smu_db_intr()
177 gpio = pmac_do_feature_call(PMAC_FTR_READ_GPIO, NULL, smu->doorbell); in smu_db_intr()
179 spin_unlock_irqrestore(&smu->lock, flags); in smu_db_intr()
183 cmd = smu->cmd_cur; in smu_db_intr()
184 smu->cmd_cur = NULL; in smu_db_intr()
198 faddr = (unsigned long)smu->cmd_buf; in smu_db_intr()
202 ack = (~cmd->cmd) & 0xff; in smu_db_intr()
203 if (ack != smu->cmd_buf->cmd) { in smu_db_intr()
205 ack, smu->cmd_buf->cmd); in smu_db_intr()
206 rc = -EIO; in smu_db_intr()
208 reply_len = rc == 0 ? smu->cmd_buf->length : 0; in smu_db_intr()
210 if (reply_len > cmd->reply_len) { in smu_db_intr()
213 reply_len, cmd->reply_len); in smu_db_intr()
214 reply_len = cmd->reply_len; in smu_db_intr()
216 cmd->reply_len = reply_len; in smu_db_intr()
217 if (cmd->reply_buf && reply_len) in smu_db_intr()
218 memcpy(cmd->reply_buf, smu->cmd_buf->data, reply_len); in smu_db_intr()
222 * ownership of the command structure as soon as it's no longer -1 in smu_db_intr()
224 done = cmd->done; in smu_db_intr()
225 misc = cmd->misc; in smu_db_intr()
227 cmd->status = rc; in smu_db_intr()
229 /* Re-enable NAP mode */ in smu_db_intr()
230 if (smu->broken_nap) in smu_db_intr()
235 spin_unlock_irqrestore(&smu->lock, flags); in smu_db_intr()
270 return -ENODEV; in smu_queue_cmd()
271 if (cmd->data_len > SMU_MAX_DATA || in smu_queue_cmd()
272 cmd->reply_len > SMU_MAX_DATA) in smu_queue_cmd()
273 return -EINVAL; in smu_queue_cmd()
275 cmd->status = 1; in smu_queue_cmd()
276 spin_lock_irqsave(&smu->lock, flags); in smu_queue_cmd()
277 list_add_tail(&cmd->link, &smu->cmd_list); in smu_queue_cmd()
278 if (smu->cmd_cur == NULL) in smu_queue_cmd()
280 spin_unlock_irqrestore(&smu->lock, flags); in smu_queue_cmd()
283 if (!smu_irq_inited || !smu->db_irq) in smu_queue_cmd()
296 struct smu_cmd *cmd = &scmd->cmd; in smu_queue_simple()
300 if (data_len > sizeof(scmd->buffer)) in smu_queue_simple()
301 return -EINVAL; in smu_queue_simple()
304 cmd->cmd = command; in smu_queue_simple()
305 cmd->data_len = data_len; in smu_queue_simple()
306 cmd->data_buf = scmd->buffer; in smu_queue_simple()
307 cmd->reply_len = sizeof(scmd->buffer); in smu_queue_simple()
308 cmd->reply_buf = scmd->buffer; in smu_queue_simple()
309 cmd->done = done; in smu_queue_simple()
310 cmd->misc = misc; in smu_queue_simple()
314 scmd->buffer[i] = (u8)va_arg(list, int); in smu_queue_simple()
329 gpio = pmac_do_feature_call(PMAC_FTR_READ_GPIO, NULL, smu->doorbell); in smu_poll()
331 smu_db_intr(smu->db_irq, smu); in smu_poll()
347 while(cmd->status == 1) in smu_spinwait_cmd()
369 cmd_buf->cmd = 0x8e; in smu_fill_set_rtc_cmd()
370 cmd_buf->length = 8; in smu_fill_set_rtc_cmd()
371 cmd_buf->data[0] = 0x80; in smu_fill_set_rtc_cmd()
372 cmd_buf->data[1] = hex2bcd(time->tm_sec); in smu_fill_set_rtc_cmd()
373 cmd_buf->data[2] = hex2bcd(time->tm_min); in smu_fill_set_rtc_cmd()
374 cmd_buf->data[3] = hex2bcd(time->tm_hour); in smu_fill_set_rtc_cmd()
375 cmd_buf->data[4] = time->tm_wday; in smu_fill_set_rtc_cmd()
376 cmd_buf->data[5] = hex2bcd(time->tm_mday); in smu_fill_set_rtc_cmd()
377 cmd_buf->data[6] = hex2bcd(time->tm_mon) + 1; in smu_fill_set_rtc_cmd()
378 cmd_buf->data[7] = hex2bcd(time->tm_year - 100); in smu_fill_set_rtc_cmd()
388 return -ENODEV; in smu_get_rtc_time()
397 time->tm_sec = bcd2hex(cmd.buffer[0]); in smu_get_rtc_time()
398 time->tm_min = bcd2hex(cmd.buffer[1]); in smu_get_rtc_time()
399 time->tm_hour = bcd2hex(cmd.buffer[2]); in smu_get_rtc_time()
400 time->tm_wday = bcd2hex(cmd.buffer[3]); in smu_get_rtc_time()
401 time->tm_mday = bcd2hex(cmd.buffer[4]); in smu_get_rtc_time()
402 time->tm_mon = bcd2hex(cmd.buffer[5]) - 1; in smu_get_rtc_time()
403 time->tm_year = bcd2hex(cmd.buffer[6]) + 100; in smu_get_rtc_time()
415 return -ENODEV; in smu_set_rtc_time()
419 hex2bcd(time->tm_sec), in smu_set_rtc_time()
420 hex2bcd(time->tm_min), in smu_set_rtc_time()
421 hex2bcd(time->tm_hour), in smu_set_rtc_time()
422 time->tm_wday, in smu_set_rtc_time()
423 hex2bcd(time->tm_mday), in smu_set_rtc_time()
424 hex2bcd(time->tm_mon) + 1, in smu_set_rtc_time()
425 hex2bcd(time->tm_year - 100)); in smu_set_rtc_time()
481 return -ENODEV; in smu_init()
492 ret = -EINVAL; in smu_init()
498 spin_lock_init(&smu->lock); in smu_init()
499 INIT_LIST_HEAD(&smu->cmd_list); in smu_init()
500 INIT_LIST_HEAD(&smu->cmd_i2c_list); in smu_init()
501 smu->of_node = np; in smu_init()
502 smu->db_irq = 0; in smu_init()
503 smu->msg_irq = 0; in smu_init()
508 smu->cmd_buf_abs = (u32)smu_cmdbuf_abs; in smu_init()
509 smu->cmd_buf = __va(smu_cmdbuf_abs); in smu_init()
511 smu->db_node = of_find_node_by_name(NULL, "smu-doorbell"); in smu_init()
512 if (smu->db_node == NULL) { in smu_init()
514 ret = -ENXIO; in smu_init()
517 data = of_get_property(smu->db_node, "reg", NULL); in smu_init()
520 ret = -ENXIO; in smu_init()
525 * and ack. GPIOs are at 0x50, best would be to find that out in smu_init()
526 * in the device-tree though. in smu_init()
528 smu->doorbell = *data; in smu_init()
529 if (smu->doorbell < 0x50) in smu_init()
530 smu->doorbell += 0x50; in smu_init()
532 /* Now look for the smu-interrupt GPIO */ in smu_init()
534 smu->msg_node = of_find_node_by_name(NULL, "smu-interrupt"); in smu_init()
535 if (smu->msg_node == NULL) in smu_init()
537 data = of_get_property(smu->msg_node, "reg", NULL); in smu_init()
539 of_node_put(smu->msg_node); in smu_init()
540 smu->msg_node = NULL; in smu_init()
543 smu->msg = *data; in smu_init()
544 if (smu->msg < 0x50) in smu_init()
545 smu->msg += 0x50; in smu_init()
548 /* Doorbell buffer is currently hard-coded, I didn't find a proper in smu_init()
549 * device-tree entry giving the address. Best would probably to use in smu_init()
552 smu->db_buf = ioremap(0x8000860c, 0x1000); in smu_init()
553 if (smu->db_buf == NULL) { in smu_init()
555 ret = -ENXIO; in smu_init()
560 smu->broken_nap = pmac_get_uninorth_variant() < 4; in smu_init()
561 if (smu->broken_nap) in smu_init()
568 of_node_put(smu->msg_node); in smu_init()
570 of_node_put(smu->db_node); in smu_init()
585 timer_setup(&smu->i2c_timer, smu_i2c_retry, 0); in smu_late_init()
587 if (smu->db_node) { in smu_late_init()
588 smu->db_irq = irq_of_parse_and_map(smu->db_node, 0); in smu_late_init()
589 if (!smu->db_irq) in smu_late_init()
591 smu->db_node); in smu_late_init()
593 if (smu->msg_node) { in smu_late_init()
594 smu->msg_irq = irq_of_parse_and_map(smu->msg_node, 0); in smu_late_init()
595 if (!smu->msg_irq) in smu_late_init()
597 smu->msg_node); in smu_late_init()
604 if (smu->db_irq) { in smu_late_init()
605 if (request_irq(smu->db_irq, smu_db_intr, in smu_late_init()
609 smu->db_irq); in smu_late_init()
610 smu->db_irq = 0; in smu_late_init()
614 if (smu->msg_irq) { in smu_late_init()
615 if (request_irq(smu->msg_irq, smu_msg_intr, in smu_late_init()
619 smu->msg_irq); in smu_late_init()
620 smu->msg_irq = 0; in smu_late_init()
640 for (np = NULL; (np = of_get_next_child(smu->of_node, np)) != NULL;) in smu_expose_childs()
641 if (of_device_is_compatible(np, "smu-sensors")) in smu_expose_childs()
642 of_platform_device_create(np, "smu-sensors", in smu_expose_childs()
643 &smu->of_dev->dev); in smu_expose_childs()
651 return -ENODEV; in smu_platform_probe()
652 smu->of_dev = dev; in smu_platform_probe()
697 return smu->of_dev; in smu_get_ofdev()
708 void (*done)(struct smu_i2c_cmd *cmd, void *misc) = cmd->done; in smu_i2c_complete_command()
709 void *misc = cmd->misc; in smu_i2c_complete_command()
713 if (!fail && cmd->read) { in smu_i2c_complete_command()
714 if (cmd->pdata[0] < 1) in smu_i2c_complete_command()
717 memcpy(cmd->info.data, &cmd->pdata[1], in smu_i2c_complete_command()
718 cmd->info.datalen); in smu_i2c_complete_command()
727 spin_lock_irqsave(&smu->lock, flags); in smu_i2c_complete_command()
728 smu->cmd_i2c_cur = NULL; in smu_i2c_complete_command()
730 cmd->status = fail ? -EIO : 0; in smu_i2c_complete_command()
733 if (!list_empty(&smu->cmd_i2c_list)) { in smu_i2c_complete_command()
737 newcmd = list_entry(smu->cmd_i2c_list.next, in smu_i2c_complete_command()
739 smu->cmd_i2c_cur = newcmd; in smu_i2c_complete_command()
740 list_del(&cmd->link); in smu_i2c_complete_command()
743 list_add_tail(&cmd->scmd.link, &smu->cmd_list); in smu_i2c_complete_command()
744 if (smu->cmd_cur == NULL) in smu_i2c_complete_command()
747 spin_unlock_irqrestore(&smu->lock, flags); in smu_i2c_complete_command()
758 struct smu_i2c_cmd *cmd = smu->cmd_i2c_cur; in smu_i2c_retry()
763 cmd->pdata[0] = 0xff; in smu_i2c_retry()
764 cmd->scmd.reply_len = sizeof(cmd->pdata); in smu_i2c_retry()
765 smu_queue_cmd(&cmd->scmd); in smu_i2c_retry()
775 cmd->stage, scmd->status, cmd->pdata[0], scmd->reply_len); in smu_i2c_low_completion()
778 if (scmd->status < 0) in smu_i2c_low_completion()
780 else if (cmd->read) { in smu_i2c_low_completion()
781 if (cmd->stage == 0) in smu_i2c_low_completion()
782 fail = cmd->pdata[0] != 0; in smu_i2c_low_completion()
784 fail = cmd->pdata[0] >= 0x80; in smu_i2c_low_completion()
786 fail = cmd->pdata[0] != 0; in smu_i2c_low_completion()
791 if (fail && --cmd->retries > 0) { in smu_i2c_low_completion()
793 BUG_ON(cmd != smu->cmd_i2c_cur); in smu_i2c_low_completion()
799 mod_timer(&smu->i2c_timer, jiffies + msecs_to_jiffies(5)); in smu_i2c_low_completion()
804 if (fail || cmd->stage != 0) { in smu_i2c_low_completion()
812 scmd->reply_buf = cmd->pdata; in smu_i2c_low_completion()
813 scmd->reply_len = sizeof(cmd->pdata); in smu_i2c_low_completion()
814 scmd->data_buf = cmd->pdata; in smu_i2c_low_completion()
815 scmd->data_len = 1; in smu_i2c_low_completion()
816 cmd->pdata[0] = 0; in smu_i2c_low_completion()
817 cmd->stage = 1; in smu_i2c_low_completion()
818 cmd->retries = 20; in smu_i2c_low_completion()
828 return -ENODEV; in smu_queue_i2c()
831 cmd->scmd.cmd = SMU_CMD_I2C_COMMAND; in smu_queue_i2c()
832 cmd->scmd.done = smu_i2c_low_completion; in smu_queue_i2c()
833 cmd->scmd.misc = cmd; in smu_queue_i2c()
834 cmd->scmd.reply_buf = cmd->pdata; in smu_queue_i2c()
835 cmd->scmd.reply_len = sizeof(cmd->pdata); in smu_queue_i2c()
836 cmd->scmd.data_buf = (u8 *)(char *)&cmd->info; in smu_queue_i2c()
837 cmd->scmd.status = 1; in smu_queue_i2c()
838 cmd->stage = 0; in smu_queue_i2c()
839 cmd->pdata[0] = 0xff; in smu_queue_i2c()
840 cmd->retries = 20; in smu_queue_i2c()
841 cmd->status = 1; in smu_queue_i2c()
846 cmd->info.caddr = cmd->info.devaddr; in smu_queue_i2c()
847 cmd->read = cmd->info.devaddr & 0x01; in smu_queue_i2c()
848 switch(cmd->info.type) { in smu_queue_i2c()
850 memset(&cmd->info.sublen, 0, 4); in smu_queue_i2c()
853 cmd->info.devaddr &= 0xfe; in smu_queue_i2c()
855 if (cmd->info.sublen > 3) in smu_queue_i2c()
856 return -EINVAL; in smu_queue_i2c()
859 return -EINVAL; in smu_queue_i2c()
864 if (cmd->read) { in smu_queue_i2c()
865 if (cmd->info.datalen > SMU_I2C_READ_MAX) in smu_queue_i2c()
866 return -EINVAL; in smu_queue_i2c()
867 memset(cmd->info.data, 0xff, cmd->info.datalen); in smu_queue_i2c()
868 cmd->scmd.data_len = 9; in smu_queue_i2c()
870 if (cmd->info.datalen > SMU_I2C_WRITE_MAX) in smu_queue_i2c()
871 return -EINVAL; in smu_queue_i2c()
872 cmd->scmd.data_len = 9 + cmd->info.datalen; in smu_queue_i2c()
877 cmd->read ? "read" : "write", cmd->info.datalen, in smu_queue_i2c()
878 cmd->info.bus, cmd->info.caddr, in smu_queue_i2c()
879 cmd->info.subaddr[0], cmd->info.type); in smu_queue_i2c()
885 spin_lock_irqsave(&smu->lock, flags); in smu_queue_i2c()
886 if (smu->cmd_i2c_cur == NULL) { in smu_queue_i2c()
887 smu->cmd_i2c_cur = cmd; in smu_queue_i2c()
888 list_add_tail(&cmd->scmd.link, &smu->cmd_list); in smu_queue_i2c()
889 if (smu->cmd_cur == NULL) in smu_queue_i2c()
892 list_add_tail(&cmd->link, &smu->cmd_i2c_list); in smu_queue_i2c()
893 spin_unlock_irqrestore(&smu->lock, flags); in smu_queue_i2c()
940 return -EIO; in smu_read_datablock()
942 len -= clen; in smu_read_datablock()
958 DPRINTK("SMU: Query partition infos ... (irq=%d)\n", smu->db_irq); in smu_create_sdb_partition()
974 * for "sdb-partition-XX" that we append at the end of the buffer in smu_create_sdb_partition()
982 prop->name = ((char *)prop) + tlen - 18; in smu_create_sdb_partition()
983 sprintf(prop->name, "sdb-partition-%02x", id); in smu_create_sdb_partition()
984 prop->length = len; in smu_create_sdb_partition()
985 prop->value = hdr; in smu_create_sdb_partition()
986 prop->next = NULL; in smu_create_sdb_partition()
996 if (hdr->id != id) { in smu_create_sdb_partition()
998 "%02x !\n", id, hdr->id); in smu_create_sdb_partition()
1001 if (of_add_property(smu->of_node, prop)) { in smu_create_sdb_partition()
1002 printk(KERN_DEBUG "SMU: Failed creating sdb-partition-%02x " in smu_create_sdb_partition()
1025 sprintf(pname, "sdb-partition-%02x", id); in __smu_get_sdb_partition()
1037 part = of_get_property(smu->of_node, pname, size); in __smu_get_sdb_partition()
1042 *size = part->len << 2; in __smu_get_sdb_partition()
1088 return -ENOMEM; in smu_open()
1089 spin_lock_init(&pp->lock); in smu_open()
1090 pp->mode = smu_file_commands; in smu_open()
1091 init_waitqueue_head(&pp->wait); in smu_open()
1095 list_add(&pp->list, &smu_clist); in smu_open()
1097 file->private_data = pp; in smu_open()
1108 wake_up_all(&pp->wait); in smu_user_cmd_done()
1115 struct smu_private *pp = file->private_data; in smu_write()
1120 if (pp->busy) in smu_write()
1121 return -EBUSY; in smu_write()
1123 return -EFAULT; in smu_write()
1125 pp->mode = smu_file_events; in smu_write()
1131 return -EINVAL; in smu_write()
1136 return -EINVAL; in smu_write()
1137 else if (pp->mode != smu_file_commands) in smu_write()
1138 return -EBADFD; in smu_write()
1140 return -EINVAL; in smu_write()
1142 spin_lock_irqsave(&pp->lock, flags); in smu_write()
1143 if (pp->busy) { in smu_write()
1144 spin_unlock_irqrestore(&pp->lock, flags); in smu_write()
1145 return -EBUSY; in smu_write()
1147 pp->busy = 1; in smu_write()
1148 pp->cmd.status = 1; in smu_write()
1149 spin_unlock_irqrestore(&pp->lock, flags); in smu_write()
1151 if (copy_from_user(pp->buffer, buf + sizeof(hdr), hdr.data_len)) { in smu_write()
1152 pp->busy = 0; in smu_write()
1153 return -EFAULT; in smu_write()
1156 pp->cmd.cmd = hdr.cmd; in smu_write()
1157 pp->cmd.data_len = hdr.data_len; in smu_write()
1158 pp->cmd.reply_len = SMU_MAX_DATA; in smu_write()
1159 pp->cmd.data_buf = pp->buffer; in smu_write()
1160 pp->cmd.reply_buf = pp->buffer; in smu_write()
1161 pp->cmd.done = smu_user_cmd_done; in smu_write()
1162 pp->cmd.misc = pp; in smu_write()
1163 rc = smu_queue_cmd(&pp->cmd); in smu_write()
1178 if (!pp->busy) in smu_read_command()
1181 return -EOVERFLOW; in smu_read_command()
1182 spin_lock_irqsave(&pp->lock, flags); in smu_read_command()
1183 if (pp->cmd.status == 1) { in smu_read_command()
1184 if (file->f_flags & O_NONBLOCK) { in smu_read_command()
1185 spin_unlock_irqrestore(&pp->lock, flags); in smu_read_command()
1186 return -EAGAIN; in smu_read_command()
1188 add_wait_queue(&pp->wait, &wait); in smu_read_command()
1192 if (pp->cmd.status != 1) in smu_read_command()
1194 rc = -ERESTARTSYS; in smu_read_command()
1197 spin_unlock_irqrestore(&pp->lock, flags); in smu_read_command()
1199 spin_lock_irqsave(&pp->lock, flags); in smu_read_command()
1202 remove_wait_queue(&pp->wait, &wait); in smu_read_command()
1204 spin_unlock_irqrestore(&pp->lock, flags); in smu_read_command()
1207 if (pp->cmd.status != 0) in smu_read_command()
1208 pp->cmd.reply_len = 0; in smu_read_command()
1209 size = sizeof(hdr) + pp->cmd.reply_len; in smu_read_command()
1213 hdr.status = pp->cmd.status; in smu_read_command()
1214 hdr.reply_len = pp->cmd.reply_len; in smu_read_command()
1216 return -EFAULT; in smu_read_command()
1217 size -= sizeof(hdr); in smu_read_command()
1218 if (size && copy_to_user(buf + sizeof(hdr), pp->buffer, size)) in smu_read_command()
1219 return -EFAULT; in smu_read_command()
1220 pp->busy = 0; in smu_read_command()
1238 struct smu_private *pp = file->private_data; in smu_read()
1240 if (pp->mode == smu_file_commands) in smu_read()
1242 if (pp->mode == smu_file_events) in smu_read()
1245 return -EBADFD; in smu_read()
1250 struct smu_private *pp = file->private_data; in smu_fpoll()
1257 if (pp->mode == smu_file_commands) { in smu_fpoll()
1258 poll_wait(file, &pp->wait, wait); in smu_fpoll()
1260 spin_lock_irqsave(&pp->lock, flags); in smu_fpoll()
1261 if (pp->busy && pp->cmd.status != 1) in smu_fpoll()
1263 spin_unlock_irqrestore(&pp->lock, flags); in smu_fpoll()
1265 if (pp->mode == smu_file_events) { in smu_fpoll()
1273 struct smu_private *pp = file->private_data; in smu_release()
1280 file->private_data = NULL; in smu_release()
1283 spin_lock_irqsave(&pp->lock, flags); in smu_release()
1284 pp->mode = smu_file_closing; in smu_release()
1285 busy = pp->busy; in smu_release()
1288 if (busy && pp->cmd.status == 1) { in smu_release()
1291 add_wait_queue(&pp->wait, &wait); in smu_release()
1294 if (pp->cmd.status != 1) in smu_release()
1296 spin_unlock_irqrestore(&pp->lock, flags); in smu_release()
1298 spin_lock_irqsave(&pp->lock, flags); in smu_release()
1301 remove_wait_queue(&pp->wait, &wait); in smu_release()
1303 spin_unlock_irqrestore(&pp->lock, flags); in smu_release()
1306 list_del(&pp->list); in smu_release()
1330 return -ENODEV; in smu_device_init()
1332 printk(KERN_ERR "via-pmu: cannot register misc device.\n"); in smu_device_init()