#include <iostream>
#include <stdlib>
#include <unistd>
#include <string>
#include "eqep.h"
#include "ip_connection.h"
#include "bricklet_lcd_16x2.h"
using namespace std;

#define HOST "localhost"
#define PORT 8000
#define UID "passiveradar" // Change to your UID

int main (int argc, char** argv)
{
    float phi, theta;
    char buffer[20];
    
    // Create IP connection
    IPConnection ipcon;
    ipcon_create(&ipcon);

    // Connect to brickd
    if(ipcon_connect(&ipcon, HOST, PORT) < 0) {
        fprintf(stderr, "Could not connect\n");
        exit(1);
    }
    // Don't use device before ipcon is connected
 
    // Allocate an instance of 
    eQEP eqep1("/sys/devices/ocp.2/48300000.epwmss/48302180.eqep", eQEP::eQEP_Mode_Absolute);
    eQEP eqep2("/sys/devices/ocp.2/48302000.epwmss/48302180.eqep", eQEP::eQEP_Mode_Absolute);
    
    // Set the unit time period to 100,000,000 ns, or 0.1 seconds
    eqep1.set_period(100000000L);
    eqep2.set_period(100000000L);

    LCD16x2 lcd;
    lcd_16x2_create(&lcd, UID, &ipcon); 

    // Turn backlight on
    lcd_16x2_backlight_on(&lcd);

    // Query back the period
    // std::cout << "[eQEP " << argv[1] << "] Period = " << eqep1.get_period() << " ns" << std::endl;
    
    // Read position indefintely
    while(1)
    {
        std::cout << "[eQEP " << argv[1] << "] Position = " << eqep1.get_position() << std::endl;
        phi = eqep1.get_position();
        theta = eqep2.get_position();

        // convert quadrature ticks into degrees - multiply by 360 deg / 4096 ticks
        phi = phi * 360 / 4096;
        theta = theta * 360 / 4096;

        // print the values into a string buffer to display on lcd
        sprintf(buffer, "Phi: %.04f\n", phi);
        lcd_16x2_write_line(&lcd, 0, 0, buffer);

        sprintf(buffer, "Theta: %.04f\n", phi);
        lcd_16x2_write_line(&lcd, 1, 0, buffer);
        // sleep 50 milliseconds to avoid overrefreshing LCD
        usleep(50*1000);
    }

    ipcon_destroy(&ipcon); // Calls ipcon_disconnect internally
    
    // Return success
    return 0;
}

#include <iostream>
#include <stdlib.h>
#include <unistd.h>
#include <string>
#include <math.h>
#include "eqep.h"
#include "ip_connection.h"
#include "bricklet_lcd_16x2.h"
using namespace std;

#define HOST "localhost"
#define PORT 8000
#define UID "passiveradar" // Change to your UID


int main (int argc, char** argv)
{
    float phi, theta;
    char buffer[20];
    char value_str[7];
    double value, voltage, DCin, powerdBm, powerLin=0;

    FILE* f0 = fopen("/sys/bus/iio/devices/iio:device0/in_voltage0_raw", "r");
    
    // Create IP connection
    IPConnection ipcon;
    ipcon_create(&ipcon);

    // Connect to brickd
    if(ipcon_connect(&ipcon, HOST, PORT) < 0) {
        fprintf(stderr, "Could not connect\n");
        exit(1);
    }
    // Don't use device before ipcon is connected
 
    LCD16x2 lcd;
    lcd_16x2_create(&lcd, UID, &ipcon); 

    // Turn backlight on
    lcd_16x2_backlight_on(&lcd);
    while(1)
    {
        // read ADC in
        fread(&value_str, 6, 6, f0);
        value = strtod(value_str,NULL,0);
        voltage = value * 1.8;
        DCin = voltage+0.4;
        powerdBm = 4*sqrt(1837-625*DCin)-135;
        powerLin = pow(10,((powerdBm-30)/10));

        printf("%d\n", value);
        fflush(stdout);

        rewind(f0); 
        
        // Print power in dBm
        sprintf(buffer, "%.2f dBm\n", powerdBm);
        lcd_16x2_write_line(&lcd, 0, 0, buffer);

        // Print power in linear scale
        if (powerLin > 1) {
            sprintf("%.3f Watts", powerLin);
        } else if (powerLin >= pow(10, -3)) {
            powerLin *= pow(10, 3);
            sprintf("%.3f mW", powerLin);
        } else if (powerLin >= pow(10, -6)) {
            powerLin *= pow(10, 6);
            sprintf("%.3f uW", powerLin);
        } else if (powerLin >= pow(10, -9)) {
            powerLin *= pow(10, 9);
            sprintf("%.3f nW", powerLin);
        } else if (powerLin >= pow(10, -12)) {
            powerLin *= pow(10, 12);
            sprintf("%.3f pW", powerLin);
        } else {
            powerLin *= pow(10, 12);
            sprintf("%.3f pW", powerLin);
        }
        lcd_16x2_write_line(&lcd, 1, 0, buffer);

        usleep(2000);
    }
    ipcon_destroy(&ipcon); // Calls ipcon_disconnect internally
    return 0;
}

}