Subversion Repositories openarty

////////////////////////////////////////////////////////////////////////////////

//

// Filename:    wbsettime

//

// Project:     OpenArty, an entirely open SoC based upon the Arty platform

//

// Purpose:     To set the on-board clock of an FPGA using the rtclight or

//              rtcclock FPGA protocols.

//

// Creator:     Dan Gisselquist, Ph.D.

//              Gisselquist Technology, LLC

//

////////////////////////////////////////////////////////////////////////////////

//

// Copyright (C) 2015-2016, Gisselquist Technology, LLC

//

// This program is free software (firmware): 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 MERCHANTIBILITY 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.  (It's in the $(ROOT)/doc directory, run make with no

// target there if the PDF file isn't present.)  If not, see

// <http://www.gnu.org/licenses/> for a copy.

//

// License:     GPL, v3, as defined and found on www.gnu.org,

//              http://www.gnu.org/licenses/gpl.html

//

//

////////////////////////////////////////////////////////////////////////////////

//

//

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include <strings.h>

#include <ctype.h>

#include <string.h>

#include <signal.h>

#include <assert.h>

#include <time.h>

#include "port.h"

#include "llcomms.h"

#include "regdefs.h"

DEVBUS  *m_fpga;

void    closeup(int v) {

        m_fpga->kill();

        exit(0);

}

int main(int argc, char **argv) {

        DEVBUS::BUSW    v;

        bool    set_time = true, read_hack = false;

        FPGAOPEN(m_fpga);

        signal(SIGSTOP, closeup);

        signal(SIGHUP, closeup);

        time_t  now, then;

        // We first wait for a second change, because we don't know how

        // much time this will take.

        DEVBUS::BUSW    clockword = 0l, dateword = 0l;

        clockword = m_fpga->readio(R_CLOCK);

        now = time(NULL);

        while(time(NULL) == now)

                ;

        if (set_time) {

                // Now, we have one second to set the time

                struct  tm      *tmp;

                int             sleepv = 0;

                then = now+1;

                tmp = localtime(&then);

                clockword &= ~0x03fffff;

                if (tmp->tm_sec != 0) {

                        // printf("THEN SECONDS = %d, ADDING %d\n",

                                // tmp->tm_sec, 60-tmp->tm_sec);

                        if (tmp->tm_sec < 58)

                                sleepv = 59 - tmp->tm_sec;

                        then += 60 - tmp->tm_sec;

                        tmp = localtime(&then);

                        // printf("Sleeping %d seconds (THEN->SEC = %d)\n", sleepv, tmp->tm_sec);

                }

                // printf("ORIGINAL : %02d:%02d:%02d\n", tmp->tm_hour, tmp->tm_min, tmp->tm_sec);

                // Seconds

                clockword |= (((tmp->tm_sec)%10)&0x0f);

                clockword |= (((tmp->tm_sec)/10)&0x0f)<< 4;

                // Minutes

                clockword |= (((tmp->tm_min)%10)&0x0f)<< 8;

                clockword |= (((tmp->tm_min)/10)&0x0f)<<12;

                // Hours

                clockword |= (((tmp->tm_hour)%10)&0x0f)<<16;

                clockword |= (((tmp->tm_hour)/10)&0x0f)<<20;

                // Years

                dateword   = 0x00000000;

                dateword  |= (((tmp->tm_year+1900)/1000)&0x0f)<<28;

                dateword  |=((((tmp->tm_year+1900)/100 )%10)&0x0f)<<24;

                dateword  |=((((tmp->tm_year+1900)/10  )%10)&0x0f)<<20;

                dateword  |=((((tmp->tm_year+1900)     )%10)&0x0f)<<16;

                dateword  |= (((tmp->tm_mon +1)/10)&0x0f)<<12;

                dateword  |= (((tmp->tm_mon +1)%10)&0x0f)<< 8;

                dateword  |= (((tmp->tm_mday  )/10)&0x0f)<< 4;

                dateword  |= (((tmp->tm_mday  )%10)&0x0f);

                if (sleepv > 0)

                        sleep(sleepv);

                while(time(NULL) < then)

                        ;

                m_fpga->writeio(R_CLOCK, clockword);

                printf("Time set to   %06x\n", clockword & 0x03fffff);

#ifdef R_DATE   // If we have the date capability

                m_fpga->writeio(R_DATE, dateword);

                printf("Date set to %08x\n", dateword);

                printf("(Now reads %08x)\n", m_fpga->readio(R_DATE));

#endif // R_DATE

                now = then;

        } if (read_hack) {

                then = time(NULL) + 5;

                while(time(NULL) < then)

                        ;

                clockword = m_fpga->readio(R_CLOCK);

        }

        if (m_fpga->poll())

                printf("FPGA was interrupted\n");

        delete  m_fpga;

}