drivers/fsi/fsi-core.c

27 #include "fsi-master.h"
97 static int fsi_master_read(struct fsi_master *master, int link,
99 static int fsi_master_write(struct fsi_master *master, int link,
101 static int fsi_master_break(struct fsi_master *master, int link);
197 	struct fsi_master *master = slave->master;
205 	rc = fsi_master_read(master, link, id, FSI_SLAVE_BASE + FSI_SISC,
210 	rc =  fsi_master_read(master, link, id, FSI_SLAVE_BASE + FSI_SSTAT,
219 	return fsi_master_write(master, link, id, FSI_SLAVE_BASE + FSI_SISC,
266 	return fsi_master_write(slave->master, slave->link, slave->id,
274 	struct fsi_master *master = slave->master;
296 	if (master->term) {
297 		rc = master->term(master, link, id);
299 			rc = fsi_master_read(master, link, id, 0,
312 	rc = fsi_master_break(master, link);
323 	if (master->link_config)
324 		master->link_config(master, link,
342 		rc = fsi_master_read(slave->master, slave->link,
367 		rc = fsi_master_write(slave->master, slave->link,
511 					slave->master->idx, slave->link,
643 static struct device_node *fsi_slave_find_of_node(struct fsi_master *master,
648 	parent = dev_of_node(&master->dev);
770 	struct fsi_master *master = slave->master;
772 	if (!master->term)
775 	master->term(master, slave->link, slave->id);
794 	struct fsi_master *master = slave->master;
804 	if (!master->link_config)
814 	if (master->link_config)
815 		master->link_config(master, slave->link,
981 static int fsi_slave_init(struct fsi_master *master, int link, uint8_t id)
995 	rc = fsi_master_read(master, link, id, 0, &data, sizeof(data));
997 		dev_dbg(&master->dev, "can't read slave %02x:%02x %d\n",
1005 		trace_fsi_slave_invalid_cfam(master, link, cfam_id);
1006 		dev_warn(&master->dev, "slave %02x:%02x invalid cfam id CRC!\n",
1011 	dev_dbg(&master->dev, "fsi: found chip %08x at %02x:%02x:%02x\n",
1012 			cfam_id, master->idx, link, id);
1014 	/* If we're behind a master that doesn't provide a self-running bus
1017 	if (master->flags & FSI_MASTER_FLAG_SWCLOCK) {
1019 		rc = fsi_master_write(master, link, id,
1023 			dev_warn(&master->dev,
1037 	slave->dev.parent = &master->dev;
1038 	slave->dev.of_node = fsi_slave_find_of_node(master, link, id);
1042 	slave->master = master;
1059 	rc = fsi_master_write(master, link, id, FSI_SLAVE_BASE + FSI_SLBUS,
1062 		dev_warn(&master->dev,
1068 		dev_warn(&master->dev,
1095 	if (master->link_config)
1096 		master->link_config(master, link,
1108 		dev_dbg(&master->dev, "failed during slave scan with: %d\n",
1121 /* FSI master support */
1136 static int fsi_master_read(struct fsi_master *master, int link,
1141 	trace_fsi_master_read(master, link, slave_id, addr, size);
1145 		rc = master->read(master, link, slave_id, addr, val, size);
1147 	trace_fsi_master_rw_result(master, link, slave_id, addr, size,
1153 static int fsi_master_write(struct fsi_master *master, int link,
1158 	trace_fsi_master_write(master, link, slave_id, addr, size, val);
1162 		rc = master->write(master, link, slave_id, addr, val, size);
1164 	trace_fsi_master_rw_result(master, link, slave_id, addr, size,
1170 static int fsi_master_link_disable(struct fsi_master *master, int link)
1172 	if (master->link_enable)
1173 		return master->link_enable(master, link, false);
1178 static int fsi_master_link_enable(struct fsi_master *master, int link)
1180 	if (master->link_enable)
1181 		return master->link_enable(master, link, true);
1189 static int fsi_master_break(struct fsi_master *master, int link)
1193 	trace_fsi_master_break(master, link);
1195 	if (master->send_break)
1196 		rc = master->send_break(master, link);
1197 	if (master->link_config)
1198 		master->link_config(master, link, 16, 16);
1203 static int fsi_master_scan(struct fsi_master *master)
1207 	trace_fsi_master_scan(master, true);
1208 	for (link = 0; link < master->n_links; link++) {
1209 		rc = fsi_master_link_enable(master, link);
1211 			dev_dbg(&master->dev,
1215 		rc = fsi_master_break(master, link);
1217 			fsi_master_link_disable(master, link);
1218 			dev_dbg(&master->dev,
1223 		rc = fsi_slave_init(master, link, 0);
1225 			fsi_master_link_disable(master, link);
1247 static void fsi_master_unscan(struct fsi_master *master)
1249 	trace_fsi_master_scan(master, false);
1250 	device_for_each_child(&master->dev, NULL, fsi_master_remove_slave);
1253 int fsi_master_rescan(struct fsi_master *master)
1257 	mutex_lock(&master->scan_lock);
1258 	fsi_master_unscan(master);
1259 	rc = fsi_master_scan(master);
1260 	mutex_unlock(&master->scan_lock);
1269 	struct fsi_master *master = to_fsi_master(dev);
1272 	rc = fsi_master_rescan(master);
1284 	struct fsi_master *master = to_fsi_master(dev);
1286 	fsi_master_break(master, 0);
1299 ATTRIBUTE_GROUPS(master);
1302 	.name = "fsi-master",
1306 int fsi_master_register(struct fsi_master *master)
1311 	mutex_init(&master->scan_lock);
1314 	if (master->idx) {
1315 		master->idx = ida_alloc_range(&master_ida, master->idx,
1316 					      master->idx, GFP_KERNEL);
1318 		master->idx = ida_alloc(&master_ida, GFP_KERNEL);
1321 	if (master->idx < 0)
1322 		return master->idx;
1324 	if (!dev_name(&master->dev))
1325 		dev_set_name(&master->dev, "fsi%d", master->idx);
1327 	master->dev.class = &fsi_master_class;
1329 	mutex_lock(&master->scan_lock);
1330 	rc = device_register(&master->dev);
1332 		ida_free(&master_ida, master->idx);
1336 	np = dev_of_node(&master->dev);
1338 		fsi_master_scan(master);
1341 	mutex_unlock(&master->scan_lock);
1346 void fsi_master_unregister(struct fsi_master *master)
1348 	int idx = master->idx;
1350 	trace_fsi_master_unregister(master);
1352 	mutex_lock(&master->scan_lock);
1353 	fsi_master_unscan(master);
1354 	master->n_links = 0;
1355 	mutex_unlock(&master->scan_lock);
1357 	device_unregister(&master->dev);