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;
266 		err = map_ref_to_tod_trig_sel(ref, &trigger);
268 		if (err) {
271 			return err;
274 		err = arm_tod_read_with_trigger(&idt82p33->channel[index], trigger);
276 		if (err == 0) {
296 	return err;
304 	int err;
306 	err = idt82p33_get_extts(&idt82p33->channel[todn], &ts);
307 	if (err == 0) {
315 	return err;
324 	int err;
340 			err = arm_tod_read_with_trigger(&idt82p33->channel[i], trigger);
341 			if (err)
343 					"%s: Arm ToD read trigger failed, err = %d",
344 					__func__, err);
346 			err = idt82p33_extts_check_channel(idt82p33, i);
347 			if (err == 0 && idt82p33->extts_single_shot)
367 	int err;
373 	err = idt82p33_set_tod_trigger(channel, HW_TOD_RD_TRIG_SEL_LSB_TOD_STS,
375 	if (err)
376 		return err;
383 	err = idt82p33_read(idt82p33, channel->dpll_tod_sts, buf, sizeof(buf));
385 	if (err)
386 		return err;
410 	int err;
413 	err = idt82p33_set_tod_trigger(channel, HW_TOD_WR_TRIG_SEL_MSB_TOD_CNFG,
415 	if (err)
416 		return err;
435 		err = idt82p33_write(idt82p33, channel->dpll_tod_cnfg + i,
437 		if (err)
438 			return err;
441 	return err;
450 	int err;
454 	err = _idt82p33_gettime(channel, &ts);
456 	if (err)
457 		return err;
464 	err = _idt82p33_settime(channel, &ts);
466 	return err;
478 	int err;
480 	err = _idt82p33_gettime(channel, &ts);
482 	if (err)
483 		return err;
498 	err = idt82p33_write(idt82p33, channel->dpll_tod_cnfg, buf, sizeof(buf));
499 	if (err)
500 		return err;
527 	int err, i;
552 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_DCO);
554 	if (err)
555 		return err;
557 	err = idt82p33_write(idt82p33, channel->dpll_freq_cnfg,
560 	return err;
581 	int err;
583 	err = _idt82p33_adjfine(channel, channel->current_freq);
584 	if (err)
585 		return err;
597 	int err;
613 	err = _idt82p33_adjfine(channel,
615 	if (err)
616 		return err;
633 	int err;
643 		err = idt82p33_write(idt82p33, channel->dpll_tod_trigger,
648 		if (err)
649 			return err;
656 	return err;
666 	int err;
676 		err = idt82p33_read(idt82p33, channel->dpll_tod_trigger,
681 		if (err)
682 			return err;
689 	return err;
699 	int err = 0;
711 			err = idt82p33_write(idt82p33,
714 			if (err)
715 				return err;
726 	return err;
734 	int err;
738 	err = _idt82p33_settime(channel, &ts1);
740 	if (err)
741 		return err;
743 	err = _idt82p33_gettime(channel, &ts2);
745 	if (!err)
748 	return err;
755 	int err;
759 	err = idt82p33_measure_settime_gettime_gap_overhead(channel, &gap_ns);
761 	if (err) {
763 			"Failed in %s with err %d!\n", __func__, err);
764 		return err;
767 	err = idt82p33_measure_one_byte_write_overhead(channel,
770 	if (err)
771 		return err;
773 	err = idt82p33_measure_one_byte_read_overhead(channel,
776 	if (err)
777 		return err;
779 	err = idt82p33_measure_tod_write_9_byte_overhead(channel);
781 	if (err)
782 		return err;
789 	return err;
797 	int err = 0;
803 			err = -EINVAL;
815 	return err;
839 	int err;
841 	err = idt82p33_read(idt82p33, channel->dpll_sync_cnfg,
843 	if (err)
844 		return err;
872 	int err;
875 	err = idt82p33_read(idt82p33, OUT_MUX_CNFG(outn), &val, sizeof(val));
876 	if (err)
877 		return err;
898 	int err;
900 	err = idt82p33_measure_tod_write_overhead(channel);
902 	if (err) {
904 			"Failed in %s with err %d!\n", __func__, err);
905 		return err;
908 	err = _idt82p33_settime(channel, &ts);
910 	if (err)
911 		return err;
937 	int err = -EOPNOTSUPP;
944 			err = idt82p33_perout_enable(channel, false,
949 			err = -ERANGE;
951 			err = idt82p33_perout_enable(channel, true,
955 		err = idt82p33_extts_enable(channel, rq, on);
963 	if (err)
965 			"Failed in %s with err %d!\n", __func__, err);
966 	return err;
981 	int err;
995 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_WPH);
996 	if (err) {
998 			"Failed in %s with err %d!\n", __func__, err);
1002 	err = idt82p33_write(idt82p33, channel->dpll_phase_cnfg, val,
1007 	return err;
1015 	int err;
1024 	err = _idt82p33_adjfine(channel, scaled_ppm);
1026 	if (err == 0)
1030 	if (err)
1032 			"Failed in %s with err %d!\n", __func__, err);
1033 	return err;
1041 	int err;
1049 		err = idt82p33_start_ddco(channel, delta_ns);
1051 		return err;
1055 	err = _idt82p33_adjtime_internal_triggered(channel, delta_ns);
1056 	if (err && delta_ns > IMMEDIATE_SNAP_THRESHOLD_NS)
1057 		err = _idt82p33_adjtime_immediate(channel, delta_ns);
1061 	if (err)
1063 			"Failed in %s with err %d!\n", __func__, err);
1064 	return err;
1072 	int err;
1075 	err = _idt82p33_gettime(channel, ts);
1078 	if (err)
1080 			"Failed in %s with err %d!\n", __func__, err);
1081 	return err;
1090 	int err;
1093 	err = _idt82p33_settime(channel, ts);
1096 	if (err)
1098 			"Failed in %s with err %d!\n", __func__, err);
1099 	return err;
1194 	int err;
1201 	err = idt82p33_channel_init(idt82p33, index);
1202 	if (err) {
1204 			"Channel_init failed in %s with err %d!\n",
1205 			__func__, err);
1206 		return err;
1215 		err = PTR_ERR(channel->ptp_clock);
1217 		return err;
1223 	err = idt82p33_dpll_set_mode(channel, PLL_MODE_DCO);
1224 	if (err) {
1226 			"Dpll_set_mode failed in %s with err %d!\n",
1227 			__func__, err);
1228 		return err;
1231 	err = idt82p33_enable_tod(channel);
1232 	if (err) {
1234 			"Enable_tod failed in %s with err %d!\n",
1235 			__func__, err);
1236 		return err;
1247 	int err;
1253 	err = idt82p33_read(idt82p33, REG_SOFT_RESET, &cfg, sizeof(cfg));
1254 	if (err) {
1256 			"Soft reset failed with err %d!\n", err);
1257 		return err;
1263 	err = idt82p33_write(idt82p33, REG_SOFT_RESET, &cfg, sizeof(cfg));
1264 	if (err)
1266 			"Cold reset failed with err %d!\n", err);
1267 	return err;
1276 	int err;
1284 	err = request_firmware(&fw, fname, idt82p33->dev);
1286 	if (err) {
1288 			"Failed in %s with err %d!\n", __func__, err);
1289 		return err;
1301 			err = -EINVAL;
1309 			err = idt82p33_check_and_set_masks(idt82p33, page,
1313 		if (err == 0) {
1318 			err = idt82p33_write(idt82p33, REG_ADDR(page, loaddr),
1322 		if (err)
1329 	return err;
1337 	int err;
1352 		err = idt82p33_extts_check_channel(idt82p33, i);
1354 		if (err == 0) {
1377 	int err;
1402 	err = idt82p33_load_firmware(idt82p33);
1403 	if (err)
1405 			 "loading firmware failed with %d\n", err);
1413 				err = idt82p33_enable_channel(idt82p33, i);
1415 				err = idt82p33_channel_init(idt82p33, i);
1416 			if (err) {
1418 					"Failed in %s with err %d!\n",
1419 					__func__, err);
1426 		err = -ENODEV;
1431 	if (err) {
1433 		return err;