mirror of
https://github.com/saymrwulf/uhd.git
synced 2026-05-16 21:10:10 +00:00
d9656de88f
* Bumped compatibility version to 3 * firmware: Ethernet, clkdist bugfixes * lib: fixed invalid rev detection
94 lines
2.2 KiB
C
94 lines
2.2 KiB
C
/*
|
|
* Copyright 2014 Ettus Research LLC
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <avr/io.h>
|
|
|
|
#include <avrlibdefs.h>
|
|
#include <debug.h>
|
|
#include <octoclock.h>
|
|
#include <clkdist.h>
|
|
#include <state.h>
|
|
|
|
// Global state variables
|
|
volatile bool g_ext_ref_present = false;
|
|
volatile bool g_gps_present = false;
|
|
volatile switch_pos_t g_switch_pos = PREFER_INTERNAL;
|
|
volatile ref_t g_ref = NO_REF;
|
|
|
|
void led(led_t which, bool on){
|
|
// selects the proper bit
|
|
uint8_t LED = 0x20 << which;
|
|
|
|
if(on)
|
|
PORTC |= LED;
|
|
else
|
|
PORTC &= ~LED;
|
|
}
|
|
|
|
void leds_off(void){
|
|
led(LED_TOP, false);
|
|
led(LED_MIDDLE, false);
|
|
led(LED_BOTTOM, false);
|
|
}
|
|
|
|
static void force_internal(void){
|
|
led(LED_TOP, true);
|
|
led(LED_MIDDLE, false);
|
|
led(LED_BOTTOM, true);
|
|
|
|
// Tell ClkDist chip to use internal signals
|
|
cli();
|
|
setup_TI_CDCE18005(Primary_GPS);
|
|
sei();
|
|
|
|
// Set PPS to internal
|
|
PORTA |= (1<<PA6);
|
|
}
|
|
|
|
static void force_external(void){
|
|
led(LED_TOP, false);
|
|
led(LED_MIDDLE, true);
|
|
led(LED_BOTTOM, true);
|
|
|
|
// Tell Clkdist chip to use external signals
|
|
cli();
|
|
setup_TI_CDCE18005(Secondary_Ext);
|
|
sei();
|
|
|
|
// Set PPS to external
|
|
PORTA &= ~(1<<PA6);
|
|
}
|
|
|
|
void prefer_internal(void){
|
|
// If internal is NOT OK, then force external
|
|
if(g_gps_present)
|
|
force_internal();
|
|
else if(g_ext_ref_present)
|
|
force_external();
|
|
else
|
|
leds_off();
|
|
}
|
|
|
|
void prefer_external(void){
|
|
// If external is NOT OK, then force internal
|
|
if(g_ext_ref_present)
|
|
force_external();
|
|
else if(g_gps_present)
|
|
force_internal();
|
|
else
|
|
leds_off();
|
|
}
|