142 	return fsi_slave_read(dev->slave, dev->addr + addr, val, size);  in fsi_device_read()
152 	return fsi_slave_write(dev->slave, dev->addr + addr, val, size);  in fsi_device_write()
160 	return fsi_slave_read(dev->slave, addr, val, sizeof(uint32_t));  in fsi_device_peek()
171 static struct fsi_device *fsi_create_device(struct fsi_slave *slave)  in fsi_create_device()  argument
179 	dev->dev.parent = &slave->dev;  in fsi_create_device()
187 static int fsi_slave_calc_addr(struct fsi_slave *slave, uint32_t *addrp,  in fsi_slave_calc_addr()  argument
193 	if (addr > slave->size)  in fsi_slave_calc_addr()
200 		if (slave->id != 0)  in fsi_slave_calc_addr()
211 static int fsi_slave_report_and_clear_errors(struct fsi_slave *slave)  in fsi_slave_report_and_clear_errors()  argument
213 	struct fsi_master *master = slave->master;  in fsi_slave_report_and_clear_errors()
218 	link = slave->link;  in fsi_slave_report_and_clear_errors()
219 	id = slave->id;  in fsi_slave_report_and_clear_errors()
231 	dev_dbg(&slave->dev, "status: 0x%08x, sisc: 0x%08x\n",  in fsi_slave_report_and_clear_errors()
271 static int fsi_slave_set_smode(struct fsi_slave *slave)  in fsi_slave_set_smode()  argument
279 	smode = fsi_slave_smode(slave->id, slave->t_send_delay, slave->t_echo_delay);  in fsi_slave_set_smode()
282 	return fsi_master_write(slave->master, slave->link, slave->id,  in fsi_slave_set_smode()
287 static int fsi_slave_handle_error(struct fsi_slave *slave, bool write,  in fsi_slave_handle_error()  argument
290 	struct fsi_master *master = slave->master;  in fsi_slave_handle_error()
298 	link = slave->link;  in fsi_slave_handle_error()
299 	id = slave->id;  in fsi_slave_handle_error()
301 	dev_dbg(&slave->dev, "handling error on %s to 0x%08x[%zd]",  in fsi_slave_handle_error()
307 	rc = fsi_slave_report_and_clear_errors(slave);  in fsi_slave_handle_error()
318 				rc = fsi_slave_report_and_clear_errors(slave);  in fsi_slave_handle_error()
324 	send_delay = slave->t_send_delay;  in fsi_slave_handle_error()
325 	echo_delay = slave->t_echo_delay;  in fsi_slave_handle_error()
332 	slave->t_send_delay = send_delay;  in fsi_slave_handle_error()
333 	slave->t_echo_delay = echo_delay;  in fsi_slave_handle_error()
335 	rc = fsi_slave_set_smode(slave);  in fsi_slave_handle_error()
341 				    slave->t_send_delay,  in fsi_slave_handle_error()
342 				    slave->t_echo_delay);  in fsi_slave_handle_error()
344 	return fsi_slave_report_and_clear_errors(slave);  in fsi_slave_handle_error()
347 int fsi_slave_read(struct fsi_slave *slave, uint32_t addr,  in fsi_slave_read()  argument
350 	uint8_t id = slave->id;  in fsi_slave_read()
353 	rc = fsi_slave_calc_addr(slave, &addr, &id);  in fsi_slave_read()
358 		rc = fsi_master_read(slave->master, slave->link,  in fsi_slave_read()
363 		err_rc = fsi_slave_handle_error(slave, false, addr, size);  in fsi_slave_read()
372 int fsi_slave_write(struct fsi_slave *slave, uint32_t addr,  in fsi_slave_write()  argument
375 	uint8_t id = slave->id;  in fsi_slave_write()
378 	rc = fsi_slave_calc_addr(slave, &addr, &id);  in fsi_slave_write()
383 		rc = fsi_master_write(slave->master, slave->link,  in fsi_slave_write()
388 		err_rc = fsi_slave_handle_error(slave, true, addr, size);  in fsi_slave_write()
397 extern int fsi_slave_claim_range(struct fsi_slave *slave,  in fsi_slave_claim_range()  argument
403 	if (addr + size > slave->size)  in fsi_slave_claim_range()
411 extern void fsi_slave_release_range(struct fsi_slave *slave,  in fsi_slave_release_range()  argument
455 	parent = dev_of_node(&dev->slave->dev);  in fsi_device_find_of_node()
468 static int fsi_slave_scan(struct fsi_slave *slave)  in fsi_slave_scan()  argument
487 		rc = fsi_slave_read(slave, (i + 1) * sizeof(data),  in fsi_slave_scan()
490 			dev_warn(&slave->dev,  in fsi_slave_scan()
498 			dev_warn(&slave->dev,  in fsi_slave_scan()
518 			dev = fsi_create_device(slave);  in fsi_slave_scan()
522 			dev->slave = slave;  in fsi_slave_scan()
529 			dev_dbg(&slave->dev,  in fsi_slave_scan()
535 					slave->master->idx, slave->link,  in fsi_slave_scan()
536 					slave->id, i - 2);  in fsi_slave_scan()
541 				dev_warn(&slave->dev, "add failed: %d\n", rc);  in fsi_slave_scan()
559 	struct fsi_slave *slave = to_fsi_slave(kobj_to_dev(kobj));  in fsi_slave_sysfs_raw_read()  local
573 		rc = fsi_slave_read(slave, off, buf + total_len, read_len);  in fsi_slave_sysfs_raw_read()
587 	struct fsi_slave *slave = to_fsi_slave(kobj_to_dev(kobj));  in fsi_slave_sysfs_raw_write()  local
601 		rc = fsi_slave_write(slave, off, buf + total_len, write_len);  in fsi_slave_sysfs_raw_write()
623 	struct fsi_slave *slave = to_fsi_slave(dev);  in fsi_slave_release()  local
625 	fsi_free_minor(slave->dev.devt);  in fsi_slave_release()
627 	kfree(slave);  in fsi_slave_release()
676 	struct fsi_slave *slave = filep->private_data;  in cfam_read()  local
693 		rc = fsi_slave_read(slave, off, &data, read_len);  in cfam_read()
712 	struct fsi_slave *slave = filep->private_data;  in cfam_write()  local
735 		rc = fsi_slave_write(slave, off, &data, write_len);  in cfam_write()
763 	struct fsi_slave *slave = container_of(inode->i_cdev, struct fsi_slave, cdev);  in cfam_open()  local
765 	file->private_data = slave;  in cfam_open()
782 	struct fsi_slave *slave = to_fsi_slave(dev);  in send_term_store()  local
783 	struct fsi_master *master = slave->master;  in send_term_store()
788 	master->term(master, slave->link, slave->id);  in send_term_store()
798 	struct fsi_slave *slave = to_fsi_slave(dev);  in slave_send_echo_show()  local
800 	return sprintf(buf, "%u\n", slave->t_send_delay);  in slave_send_echo_show()
806 	struct fsi_slave *slave = to_fsi_slave(dev);  in slave_send_echo_store()  local
807 	struct fsi_master *master = slave->master;  in slave_send_echo_store()
821 	slave->t_send_delay = val;  in slave_send_echo_store()
822 	slave->t_echo_delay = val;  in slave_send_echo_store()
824 	rc = fsi_slave_set_smode(slave);  in slave_send_echo_store()
828 		master->link_config(master, slave->link,  in slave_send_echo_store()
829 				    slave->t_send_delay,  in slave_send_echo_store()
830 				    slave->t_echo_delay);  in slave_send_echo_store()
842 	struct fsi_slave *slave = to_fsi_slave(dev);  in chip_id_show()  local
844 	return sprintf(buf, "%d\n", slave->chip_id);  in chip_id_show()
853 	struct fsi_slave *slave = to_fsi_slave(dev);  in cfam_id_show()  local
855 	return sprintf(buf, "0x%x\n", slave->cfam_id);  in cfam_id_show()
880 	struct fsi_slave *slave = to_fsi_slave(dev);  in cfam_devnode()  local
883 	return kasprintf(GFP_KERNEL, "fsi/cfam%d", slave->cdev_idx);  in cfam_devnode()
885 	return kasprintf(GFP_KERNEL, "cfam%d", slave->cdev_idx);  in cfam_devnode()
921 static int __fsi_get_new_minor(struct fsi_slave *slave, enum fsi_dev_type type,  in __fsi_get_new_minor()  argument
924 	int cid = slave->chip_id;  in __fsi_get_new_minor()
954 	return __fsi_get_new_minor(fdev->slave, type, out_dev, out_index);  in fsi_get_new_minor()
967 	struct fsi_slave *slave;  in fsi_slave_init()  local
1013 	slave = kzalloc(sizeof(*slave), GFP_KERNEL);  in fsi_slave_init()
1014 	if (!slave)  in fsi_slave_init()
1017 	dev_set_name(&slave->dev, "slave@%02x:%02x", link, id);  in fsi_slave_init()
1018 	slave->dev.type = &cfam_type;  in fsi_slave_init()
1019 	slave->dev.parent = &master->dev;  in fsi_slave_init()
1020 	slave->dev.of_node = fsi_slave_find_of_node(master, link, id);  in fsi_slave_init()
1021 	slave->dev.release = fsi_slave_release;  in fsi_slave_init()
1022 	device_initialize(&slave->dev);  in fsi_slave_init()
1023 	slave->cfam_id = cfam_id;  in fsi_slave_init()
1024 	slave->master = master;  in fsi_slave_init()
1025 	slave->link = link;  in fsi_slave_init()
1026 	slave->id = id;  in fsi_slave_init()
1027 	slave->size = FSI_SLAVE_SIZE_23b;  in fsi_slave_init()
1028 	slave->t_send_delay = 16;  in fsi_slave_init()
1029 	slave->t_echo_delay = 16;  in fsi_slave_init()
1032 	slave->chip_id = -1;  in fsi_slave_init()
1033 	if (slave->dev.of_node) {  in fsi_slave_init()
1035 		if (!of_property_read_u32(slave->dev.of_node, "chip-id", &prop))  in fsi_slave_init()
1036 			slave->chip_id = prop;  in fsi_slave_init()
1041 	rc = __fsi_get_new_minor(slave, fsi_dev_cfam, &slave->dev.devt,  in fsi_slave_init()
1042 				 &slave->cdev_idx);  in fsi_slave_init()
1047 	cdev_init(&slave->cdev, &cfam_fops);  in fsi_slave_init()
1048 	rc = cdev_device_add(&slave->cdev, &slave->dev);  in fsi_slave_init()
1050 		dev_err(&slave->dev, "Error %d creating slave device\n", rc);  in fsi_slave_init()
1054 	rc = fsi_slave_set_smode(slave);  in fsi_slave_init()
1059 		kfree(slave);  in fsi_slave_init()
1064 				    slave->t_send_delay,  in fsi_slave_init()
1065 				    slave->t_echo_delay);  in fsi_slave_init()
1068 	rc = device_create_bin_file(&slave->dev, &fsi_slave_raw_attr);  in fsi_slave_init()
1070 		dev_warn(&slave->dev, "failed to create raw attr: %d\n", rc);  in fsi_slave_init()
1073 	rc = fsi_slave_scan(slave);  in fsi_slave_init()
1081 	put_device(&slave->dev);  in fsi_slave_init()
1191 	struct fsi_slave *slave = to_fsi_slave(dev);  in fsi_master_remove_slave()  local
1194 	cdev_device_del(&slave->cdev, &slave->dev);  in fsi_master_remove_slave()