drivers/fsi/fsi-core.c

28 #include "fsi-slave.h"
51  * FSI slave engine control register offsets
126 	return fsi_slave_read(dev->slave, dev->addr + addr, val, size);
136 	return fsi_slave_write(dev->slave, dev->addr + addr, val, size);
144 	return fsi_slave_read(dev->slave, addr, val, sizeof(uint32_t));
155 static struct fsi_device *fsi_create_device(struct fsi_slave *slave)
163 	dev->dev.parent = &slave->dev;
170 /* FSI slave support */
171 static int fsi_slave_calc_addr(struct fsi_slave *slave, uint32_t *addrp,
177 	if (addr > slave->size)
180 	/* For 23 bit addressing, we encode the extra two bits in the slave
181 	 * id (and the slave's actual ID needs to be 0).
184 		if (slave->id != 0)
195 static int fsi_slave_report_and_clear_errors(struct fsi_slave *slave)
197 	struct fsi_master *master = slave->master;
202 	link = slave->link;
203 	id = slave->id;
215 	dev_dbg(&slave->dev, "status: 0x%08x, sisc: 0x%08x\n",
223 /* Encode slave local bus echo delay */
229 /* Encode slave local bus send delay */
235 /* Encode slave local bus clock rate ratio */
241 /* Encode slave ID */
255 static int fsi_slave_set_smode(struct fsi_slave *slave)
260 	/* set our smode register with the slave ID field to 0; this enables
261 	 * extended slave addressing
263 	smode = fsi_slave_smode(slave->id, slave->t_send_delay, slave->t_echo_delay);
266 	return fsi_master_write(slave->master, slave->link, slave->id,
271 static int fsi_slave_handle_error(struct fsi_slave *slave, bool write,
274 	struct fsi_master *master = slave->master;
282 	link = slave->link;
283 	id = slave->id;
285 	dev_dbg(&slave->dev, "handling error on %s to 0x%08x[%zd]",
289 	 * communication with the slave
291 	rc = fsi_slave_report_and_clear_errors(slave);
302 				rc = fsi_slave_report_and_clear_errors(slave);
308 	send_delay = slave->t_send_delay;
309 	echo_delay = slave->t_echo_delay;
311 	/* getting serious, reset the slave via BREAK */
316 	slave->t_send_delay = send_delay;
317 	slave->t_echo_delay = echo_delay;
319 	rc = fsi_slave_set_smode(slave);
325 				    slave->t_send_delay,
326 				    slave->t_echo_delay);
328 	return fsi_slave_report_and_clear_errors(slave);
331 int fsi_slave_read(struct fsi_slave *slave, uint32_t addr,
334 	uint8_t id = slave->id;
337 	rc = fsi_slave_calc_addr(slave, &addr, &id);
342 		rc = fsi_master_read(slave->master, slave->link,
347 		err_rc = fsi_slave_handle_error(slave, false, addr, size);
356 int fsi_slave_write(struct fsi_slave *slave, uint32_t addr,
359 	uint8_t id = slave->id;
362 	rc = fsi_slave_calc_addr(slave, &addr, &id);
367 		rc = fsi_master_write(slave->master, slave->link,
372 		err_rc = fsi_slave_handle_error(slave, true, addr, size);
381 int fsi_slave_claim_range(struct fsi_slave *slave,
387 	if (addr + size > slave->size)
395 void fsi_slave_release_range(struct fsi_slave *slave,
421 /* Find a matching node for the slave engine at @address, using @size bytes
429 	parent = dev_of_node(&dev->slave->dev);
442 static int fsi_slave_scan(struct fsi_slave *slave)
450 	 * We keep the peek mode and slave engines for the core; so start
461 		rc = fsi_slave_read(slave, (i + 1) * sizeof(data),
464 			dev_warn(&slave->dev,
465 				"error reading slave registers\n");
472 			dev_warn(&slave->dev,
473 				"crc error in slave register at 0x%04x\n",
492 			dev = fsi_create_device(slave);
496 			dev->slave = slave;
505 			dev_dbg(&slave->dev,
511 					slave->master->idx, slave->link,
512 					slave->id, i - 2);
517 				dev_warn(&slave->dev, "add failed: %d\n", rc);
560 	struct fsi_slave *slave = to_fsi_slave(kobj_to_dev(kobj));
573 		rc = fsi_slave_read(slave, off, buf + total_len, read_len);
587 	struct fsi_slave *slave = to_fsi_slave(kobj_to_dev(kobj));
600 		rc = fsi_slave_write(slave, off, buf + total_len, write_len);
622 	struct fsi_slave *slave = to_fsi_slave(dev);
624 	fsi_free_minor(slave->dev.devt);
626 	kfree(slave);
640 /* Find a matching node for the slave at (link, id). Returns NULL if none
663 	struct fsi_slave *slave = filep->private_data;
680 		rc = fsi_slave_read(slave, off, &data, read_len);
699 	struct fsi_slave *slave = filep->private_data;
722 		rc = fsi_slave_write(slave, off, &data, write_len);
750 	struct fsi_slave *slave = container_of(inode->i_cdev, struct fsi_slave, cdev);
752 	file->private_data = slave;
769 	struct fsi_slave *slave = to_fsi_slave(dev);
770 	struct fsi_master *master = slave->master;
775 	master->term(master, slave->link, slave->id);
785 	struct fsi_slave *slave = to_fsi_slave(dev);
787 	return sprintf(buf, "%u\n", slave->t_send_delay);
793 	struct fsi_slave *slave = to_fsi_slave(dev);
794 	struct fsi_master *master = slave->master;
808 	slave->t_send_delay = val;
809 	slave->t_echo_delay = val;
811 	rc = fsi_slave_set_smode(slave);
815 		master->link_config(master, slave->link,
816 				    slave->t_send_delay,
817 				    slave->t_echo_delay);
829 	struct fsi_slave *slave = to_fsi_slave(dev);
831 	return sprintf(buf, "%d\n", slave->chip_id);
840 	struct fsi_slave *slave = to_fsi_slave(dev);
842 	return sprintf(buf, "0x%x\n", slave->cfam_id);
867 	const struct fsi_slave *slave = to_fsi_slave(dev);
870 	return kasprintf(GFP_KERNEL, "fsi/cfam%d", slave->cdev_idx);
872 	return kasprintf(GFP_KERNEL, "cfam%d", slave->cdev_idx);
908 static int __fsi_get_new_minor(struct fsi_slave *slave, enum fsi_dev_type type,
911 	int cid = slave->chip_id;
971 	return __fsi_get_new_minor(fdev->slave, type, out_dev, out_index);
984 	struct fsi_slave *slave;
997 		dev_dbg(&master->dev, "can't read slave %02x:%02x %d\n",
1006 		dev_warn(&master->dev, "slave %02x:%02x invalid cfam id CRC!\n",
1015 	 * clock, put the slave into async mode
1024 				"can't set llmode on slave:%02x:%02x %d\n",
1028 	/* We can communicate with a slave; create the slave device and
1031 	slave = kzalloc(sizeof(*slave), GFP_KERNEL);
1032 	if (!slave)
1035 	dev_set_name(&slave->dev, "slave@%02x:%02x", link, id);
1036 	slave->dev.type = &cfam_type;
1037 	slave->dev.parent = &master->dev;
1038 	slave->dev.of_node = fsi_slave_find_of_node(master, link, id);
1039 	slave->dev.release = fsi_slave_release;
1040 	device_initialize(&slave->dev);
1041 	slave->cfam_id = cfam_id;
1042 	slave->master = master;
1043 	slave->link = link;
1044 	slave->id = id;
1045 	slave->size = FSI_SLAVE_SIZE_23b;
1046 	slave->t_send_delay = 16;
1047 	slave->t_echo_delay = 16;
1050 	slave->chip_id = -1;
1051 	if (slave->dev.of_node) {
1053 		if (!of_property_read_u32(slave->dev.of_node, "chip-id", &prop))
1054 			slave->chip_id = prop;
1063 			 "can't set slbus on slave:%02x:%02x %d\n", link, id,
1066 	rc = fsi_slave_set_smode(slave);
1069 				"can't set smode on slave:%02x:%02x %d\n",
1075 	rc = __fsi_get_new_minor(slave, fsi_dev_cfam, &slave->dev.devt,
1076 				 &slave->cdev_idx);
1080 	trace_fsi_slave_init(slave);
1083 	cdev_init(&slave->cdev, &cfam_fops);
1084 	rc = cdev_device_add(&slave->cdev, &slave->dev);
1086 		dev_err(&slave->dev, "Error %d creating slave device\n", rc);
1097 				    slave->t_send_delay,
1098 				    slave->t_echo_delay);
1101 	rc = device_create_bin_file(&slave->dev, &fsi_slave_raw_attr);
1103 		dev_warn(&slave->dev, "failed to create raw attr: %d\n", rc);
1106 	rc = fsi_slave_scan(slave);
1108 		dev_dbg(&master->dev, "failed during slave scan with: %d\n",
1114 	fsi_free_minor(slave->dev.devt);
1116 	of_node_put(slave->dev.of_node);
1117 	kfree(slave);
1239 	struct fsi_slave *slave = to_fsi_slave(dev);
1242 	cdev_device_del(&slave->cdev, &slave->dev);