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)