drivers/ptp/ptp_idt82p33.c

104 	int err;
109 	err = idt82p33_read(idt82p33, channel->dpll_mode_cnfg,
111 	if (err)
112 		return err;
118 	err = idt82p33_write(idt82p33, channel->dpll_mode_cnfg,
120 	if (err)
121 		return err;
132 	int err;
138 	err = idt82p33_read(idt82p33, channel->dpll_tod_trigger,
141 	if (err)
142 		return err;
160 	int err;
162 	err = idt82p33_read(idt82p33, channel->dpll_tod_sts, buf, sizeof(buf));
164 	if (err)
165 		return err;
185 	int err = 0;
198 		err = -EINVAL;
201 	return err;
217 	int err;
220 	err = idt82p33_read(idt82p33, channel->dpll_tod_sts, buf, sizeof(buf));
222 	if (err)
223 		return err;
227 	err = idt82p33_set_tod_trigger(channel, trigger, false);
229 	if (err)
230 		dev_err(idt82p33->dev, "%s: err = %d", __func__, err);
232 	return err;
241 	int err = 0;
278 		err = map_ref_to_tod_trig_sel(ref, &trigger);
280 		if (err) {
283 			return err;
286 		err = arm_tod_read_with_trigger(&idt82p33->channel[index], trigger);
288 		if (err == 0) {
308 	return err;
316 	int err;
318 	err = idt82p33_get_extts(&idt82p33->channel[todn], &ts);
319 	if (err == 0) {
327 	return err;
336 	int err;
352 			err = arm_tod_read_with_trigger(&idt82p33->channel[i], trigger);
353 			if (err)
355 					"%s: Arm ToD read trigger failed, err = %d",
356 					__func__, err);
358 			err = idt82p33_extts_check_channel(idt82p33, i);
359 			if (err == 0 && idt82p33->extts_single_shot)
379 	int err;
385 	err = idt82p33_set_tod_trigger(channel, HW_TOD_RD_TRIG_SEL_LSB_TOD_STS,
387 	if (err)
388 		return err;
395 	err = idt82p33_read(idt82p33, channel->dpll_tod_sts, buf, sizeof(buf));
397 	if (err)
398 		return err;
422 	int err;
425 	err = idt82p33_set_tod_trigger(channel, HW_TOD_WR_TRIG_SEL_MSB_TOD_CNFG,
427 	if (err)
428 		return err;
447 		err = idt82p33_write(idt82p33, channel->dpll_tod_cnfg + i,
449 		if (err)
450 			return err;
453 	return err;
462 	int err;
466 	err = _idt82p33_gettime(channel, &ts);
468 	if (err)
469 		return err;
476 	err = _idt82p33_settime(channel, &ts);
478 	return err;
490 	int err;
492 	err = _idt82p33_gettime(channel, &ts);
494 	if (err)
495 		return err;
510 	err = idt82p33_write(idt82p33, channel->dpll_tod_cnfg, buf, sizeof(buf));
511 	if (err)
512 		return err;
539 	int err, i;
564 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_DCO);
566 	if (err)
567 		return err;
569 	err = idt82p33_write(idt82p33, channel->dpll_freq_cnfg,
572 	return err;
593 	int err;
595 	err = _idt82p33_adjfine(channel, channel->current_freq);
596 	if (err)
597 		return err;
609 	int err;
625 	err = _idt82p33_adjfine(channel,
627 	if (err)
628 		return err;
645 	int err;
655 		err = idt82p33_write(idt82p33, channel->dpll_tod_trigger,
660 		if (err)
661 			return err;
668 	return err;
678 	int err;
688 		err = idt82p33_read(idt82p33, channel->dpll_tod_trigger,
693 		if (err)
694 			return err;
701 	return err;
711 	int err = 0;
723 			err = idt82p33_write(idt82p33,
726 			if (err)
727 				return err;
738 	return err;
746 	int err;
750 	err = _idt82p33_settime(channel, &ts1);
752 	if (err)
753 		return err;
755 	err = _idt82p33_gettime(channel, &ts2);
757 	if (!err)
760 	return err;
767 	int err;
771 	err = idt82p33_measure_settime_gettime_gap_overhead(channel, &gap_ns);
773 	if (err) {
775 			"Failed in %s with err %d!\n", __func__, err);
776 		return err;
779 	err = idt82p33_measure_one_byte_write_overhead(channel,
782 	if (err)
783 		return err;
785 	err = idt82p33_measure_one_byte_read_overhead(channel,
788 	if (err)
789 		return err;
791 	err = idt82p33_measure_tod_write_9_byte_overhead(channel);
793 	if (err)
794 		return err;
801 	return err;
809 	int err = 0;
815 			err = -EINVAL;
827 	return err;
851 	int err;
853 	err = idt82p33_read(idt82p33, channel->dpll_sync_cnfg,
855 	if (err)
856 		return err;
884 	int err;
887 	err = idt82p33_read(idt82p33, OUT_MUX_CNFG(outn), &val, sizeof(val));
888 	if (err)
889 		return err;
910 	int err;
912 	err = idt82p33_measure_tod_write_overhead(channel);
914 	if (err) {
916 			"Failed in %s with err %d!\n", __func__, err);
917 		return err;
920 	err = _idt82p33_settime(channel, &ts);
922 	if (err)
923 		return err;
949 	int err = -EOPNOTSUPP;
956 			err = idt82p33_perout_enable(channel, false,
961 			err = -ERANGE;
963 			err = idt82p33_perout_enable(channel, true,
967 		err = idt82p33_extts_enable(channel, rq, on);
975 	if (err)
977 			"Failed in %s with err %d!\n", __func__, err);
978 	return err;
993 	int err;
1007 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_WPH);
1008 	if (err) {
1010 			"Failed in %s with err %d!\n", __func__, err);
1014 	err = idt82p33_write(idt82p33, channel->dpll_phase_cnfg, val,
1019 	return err;
1027 	int err;
1036 	err = _idt82p33_adjfine(channel, scaled_ppm);
1038 	if (err == 0)
1042 	if (err)
1044 			"Failed in %s with err %d!\n", __func__, err);
1045 	return err;
1053 	int err;
1061 		err = idt82p33_start_ddco(channel, delta_ns);
1063 		return err;
1067 	err = _idt82p33_adjtime_internal_triggered(channel, delta_ns);
1068 	if (err && delta_ns > IMMEDIATE_SNAP_THRESHOLD_NS)
1069 		err = _idt82p33_adjtime_immediate(channel, delta_ns);
1073 	if (err)
1075 			"Failed in %s with err %d!\n", __func__, err);
1076 	return err;
1084 	int err;
1087 	err = _idt82p33_gettime(channel, ts);
1090 	if (err)
1092 			"Failed in %s with err %d!\n", __func__, err);
1093 	return err;
1102 	int err;
1105 	err = _idt82p33_settime(channel, ts);
1108 	if (err)
1110 			"Failed in %s with err %d!\n", __func__, err);
1111 	return err;
1203 	int err;
1210 	err = idt82p33_channel_init(idt82p33, index);
1211 	if (err) {
1213 			"Channel_init failed in %s with err %d!\n",
1214 			__func__, err);
1215 		return err;
1224 		err = PTR_ERR(channel->ptp_clock);
1226 		return err;
1232 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_DCO);
1233 	if (err) {
1235 			"Dpll_set_mode failed in %s with err %d!\n",
1236 			__func__, err);
1237 		return err;
1240 	err = idt82p33_enable_tod(channel);
1241 	if (err) {
1243 			"Enable_tod failed in %s with err %d!\n",
1244 			__func__, err);
1245 		return err;
1256 	int err;
1262 	err = idt82p33_read(idt82p33, REG_SOFT_RESET, &cfg, sizeof(cfg));
1263 	if (err) {
1265 			"Soft reset failed with err %d!\n", err);
1266 		return err;
1272 	err = idt82p33_write(idt82p33, REG_SOFT_RESET, &cfg, sizeof(cfg));
1273 	if (err)
1275 			"Cold reset failed with err %d!\n", err);
1276 	return err;
1285 	int err;
1293 	err = request_firmware(&fw, fname, idt82p33->dev);
1295 	if (err) {
1297 			"Failed in %s with err %d!\n", __func__, err);
1298 		return err;
1310 			err = -EINVAL;
1318 			err = idt82p33_check_and_set_masks(idt82p33, page,
1322 		if (err == 0) {
1327 			err = idt82p33_write(idt82p33, REG_ADDR(page, loaddr),
1331 		if (err)
1338 	return err;
1346 	int err;
1361 		err = idt82p33_extts_check_channel(idt82p33, i);
1363 		if (err == 0) {
1386 	int err;
1411 	err = idt82p33_load_firmware(idt82p33);
1412 	if (err)
1414 			 "loading firmware failed with %d\n", err);
1422 				err = idt82p33_enable_channel(idt82p33, i);
1424 				err = idt82p33_channel_init(idt82p33, i);
1425 			if (err) {
1427 					"Failed in %s with err %d!\n",
1428 					__func__, err);
1435 		err = -ENODEV;
1440 	if (err) {
1442 		return err;