#!/usr/bin/env python
# -*- coding: utf-8 -*-
import numpy as np
from scipy import optimize
from pylab import *

rser1 = 100e3
rser2 = 10e3
cp1 = 137
cp2 = 17

def hc(ptheta, f):
    '''
    Комплексная передаточная функция цепочки 
      +----+
    --+ R1 +---+----+----
      +----+   |    |
               |   +++
            C ---  | | RL
              ---  +++
               |    |
               |   C
               |   C   L
               |   C
               |    |
              ---  ---
               
    :param ptheta: вектор параметров r1, rl, l, c/1e-12
    :param f: вектор частот
    '''
    (r1, rl, l, c) = ptheta
    c = c * 1e-12
    jom = 1j * 2 * np.pi * f
    zc = 1 / jom / c
    zl = rl + jom * l 
    zpar = 1 / (1 / zc + 1 / zl)
    zser = r1
    hc = zpar / (zpar + zser)
    return hc
    
def fit_crit(theta, f, hc1, hc2, hc3):
    '''
    Функция для минимизации
    :param theta: вектор параметров l, rl, cl/1e-12 
    :param f: вектор частот
    :param hc_: измеренная компл. перед. фун.
    '''
    (l, rl, cl) = theta
    hct1 = hc([rser1, rl, l, cl + cp2], f)
    hct2 = hc([rser1, rl, l, cl + cp1], f)
    hct3 = hc([rser2, rl, l, cl + cp1], f)
    s = hct1.shape[0] - hc1.shape[0]
    hct1 = hct1[s:]
    diff1 = np.abs(hct1 - hc1)
    diff2 = np.abs(hct2 - hc2)
    diff3 = np.abs(hct3 - hc3)
    ans = 1 * np.sum(diff1) + 1 * np.sum(diff2) + 1 * np.sum(diff3)
    return ans

def load_fr_resp(fn):
    '''
    Загрузка перед. фун.
    :param fn: имя файла
    '''
    data = np.loadtxt(fn)
    freq = data[:, 0]
    magn = np.power(10, data[:, 1] / 20)
    phase = data[:, 2] / 180 * np.pi
    resp = magn * (np.cos(phase) + 1j * np.sin(phase))
    return (freq, resp)
    
    
def main():
    f1, hc1 = load_fr_resp('FREQ_tvs100k_div10.CSV')
    f, hc2 = load_fr_resp('FREQ_tvs100k.CSV')
    unused, hc3 = load_fr_resp('FREQ_tvs10k.CSV')

    unused, hcprobe10 = load_fr_resp('FREQ_PROBE10.CSV')
    unused, hcprobe1 = load_fr_resp('FREQ_PROBE1.CSV')

    probe_correction = True
    
    if probe_correction:
        s = hcprobe10.shape[0] - hc1.shape[0]
        hcprobe10r = hcprobe10[s:]
        hc1r = hc1 / hcprobe10r
        hc2r = hc2 / hcprobe1
        hc3r = hc3 / hcprobe1
    else:
        hc1r = hc1 * 10
        hc2r = hc2
        hc3r = hc3

    theta0 = [1e-1, 400.0, 1]

    theta = optimize.fmin_powell(fit_crit, theta0,
        args=(f, hc1r, hc2r, hc3r),
    )
    
    print theta

    (l, rl, cl) = theta
    if probe_correction:
        hct1 = hc([rser1, rl, l, cl + cp2], f) * hcprobe10
        hct2 = hc([rser1, rl, l, cl + cp1], f) * hcprobe1
        hct3 = hc([rser2, rl, l, cl + cp1], f) * hcprobe1
    else:
        hct1 = hc([rser1, rl, l, cl + cp2], f) / 10
        hct2 = hc([rser1, rl, l, cl + cp1], f)
        hct3 = hc([rser2, rl, l, cl + cp1], f)
    

    subplot(231)
    s = hct1.shape[0] - f1.shape[0]
    hct1 = hct1[s:]
    loglog(f1, np.abs(hct1), f1, np.abs(hc1), 'x')
    ylabel('Magnitude')
    subplot(232)
    loglog(f, np.abs(hct2), f, np.abs(hc2), 'x')
    subplot(233)
    loglog(f, np.abs(hct3), f, np.abs(hc3), 'x')
    subplot(234)
    semilogx(f1, np.angle(hct1, deg=True), f1, np.angle(hc1, deg=True), 'x')
    xlabel('f, Hz')
    ylabel('Phase, deg')
    subplot(235)
    semilogx(f, np.angle(hct2, deg=True), f, np.angle(hc2, deg=True), 'x')
    xlabel('f, Hz')
    subplot(236)
    semilogx(f, np.angle(hct3, deg=True), f, np.angle(hc3, deg=True), 'x')
    xlabel('f, Hz')
    show()
    
if __name__ == '__main__':
    main()
