Files
sf-op/script/CPython/hfitoff.py
voulot_d 202cf3bb79 Startup
2017-05-30 17:28:37 +02:00

26 lines
932 B
Python

import numpy as np
from scipy.optimize import leastsq
def hfitoff(data, xdeg):
"""
Harmonic fit with offset
"""
start, end = min(xdeg), max(xdeg)
guess_amplitude = 2 ** 0.5 * np.std(data)
guess_phase = 0
guess_offset = np.mean(data)
xrad = xdeg / 180 * np.pi
optimize_func = lambda x: x[0] * np.sin(xrad + x[1]) + x[2] - data
fit_amplitude, fit_phase, fit_offset = leastsq(optimize_func, [guess_amplitude, guess_phase, guess_offset])[0]
if fit_amplitude < 0:
fit_amplitude = -fit_amplitude
fit_phase = fit_phase - np.pi
fit_xdeg = np.linspace(start, end, 100)
fit_data = fit_amplitude * np.sin(fit_xdeg / 180 * np.pi + fit_phase) + fit_offset
fit_phase_deg = fit_phase / np.pi * 180
ph_crest = 90 - fit_phase_deg
if ph_crest > 180:
ph_crest = ph_crest - 360
return (fit_amplitude, fit_phase_deg, fit_offset, ph_crest, fit_xdeg, fit_data)