/*
 * gnss.cpp
 *
 *  Created on: Dec 29, 2014
 *      Author: aras
 */

#include <gnss.h>
#include <cassert>
#include <cctype>


bool te_gnss::configure(gnss_config_struct &gcs) {
	bool r;
	r = activate();
	r = r && set_baudrate(gcs.baudrate);
	r = r && set_position(gcs.lat,gcs.lon);
	return r && activate_nmea_frames(gcs.nmea_mask);
}


bool te_gnss::activate() {
	PORTD |= (1<<PK0);
	return PORTD & (1<<PK0);
}


bool te_gnss::deactivate() {
	PORTD &= ~(1<<PK0);
	return (~PORTD) & (1<<PK0);
}



bool te_gnss::sync_pps() {
	return true;
}



bool te_gnss::set_baudrate(uint16_t baud){
	if(not scan_baud_success){
		scan_baud_finish = false;
		scan_baudrate();
		while(not scan_baud_finish){}// TODO sleep()
	}
	if(scan_baud_success){
		write_baud(GNSS_PORT,baud);
	}else{
		return false;
	}
	return true;
}


bool te_gnss::wait_to_be_locked(){
	scan_lock_finish = false;
	scan_lock_success = false;
	if(scan_baud_success){
		lock_idx = 0;
		push(pfunc_pps);
		pfunc_pps = &scan_lock_func;
		while(! scan_lock_finish){}// TODO sleep()
		if(scan_lock_success){
			PORTL != (1<<PL7);
			return true;
		}
	}
	return false;
}


bool te_gnss::get_pps_data(bool raw){
	if(scan_baud_success){
		is_raw = raw;
		stk_ptr = 0;
		stack[0] = nullptr;
		pfunc_pps = &get_pps_data_func;
	}else{
		return false;
	}
	return true;
}


bool te_gnss::set_position(fix32 lat, fix32 lon){
	return true; // TODO all
}


bool te_gnss::activate_nmea_frames(uint16_t mask){
	return true; // TODO all
}


void te_gnss::ISR_pps(){
	pfunc_pps();
}


void te_gnss::ISR_pps_at(){
	// TODO inicializa interrupcion de contador
}