Subversion Repositories s6soc

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

//

// Filename:    rtcsim.c

//

// Project:     CMod S6 System on a Chip, ZipCPU demonstration project

//

// Purpose:     Since we lost the real-time clock on board due to space

//              constraints, this unit attempts to replace that functionality

//      in software.

//

// 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 "rtcsim.h"

unsigned        rtcclock, rtcalarm, rtcdate;

#ifdef  ZIPOS

// SEMAPHORE    SEMDATE, SEMCLOCK;

#endif

unsigned        rtcnext(unsigned now) {

        now = now+1;

        if ((now & 0x0f)>=0x0a) {

                now += 0x06; // Seconds

                if ((now & 0x0f0)> 0x050) {

                        now += 0x0a0; // Increment minutes

                        if ((now & 0x0f00)>= 0x0a00) {

                                now += 0x0600;

                                if ((now & 0x0f000)> 0x05000) {

                                        now += 0x0a000; // Increment hours

                                        if ((now & 0x0f0000)>= 0x0a0000)

                                                now += 0x060000;

                                        if (now >= 0x0240000)

                                                now = 0;

                                }

                        }

                }

        }

        return now;

}

static const int days_per_month[] = {

        31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31

};

unsigned        rtcdatenext(unsigned today) {

        int dy, mo;

        dy = (today&0x0f)+((today>>4)&0x03)*10;

        mo = ((today>>8)&0x0f)+(today&0x0100)?10:0;

        dy = dy+1;

        if ((mo>12)||(dy > days_per_month[mo-1])) {

                if (mo == 2) {

                        // If its a leap year

                        //      If it is divisible by four

                        //              But not a century year

                        //                      unless it's a fourth century yr

                        int     tst;

                        if ((today&0x0ff0000) == 0) {

                                tst = (today >> 24) & 0x03f;

                        } else {

                                tst = (today >> 20) & 0x0ff;

                        } tst &= 0x013;

                        if ((tst==0)||(tst==0x012)) {

                                // Divisible by four

                                if (dy >= 29)

                                        dy = 1;

                        } else dy = 1;

                } else dy = 1;

        } if (dy == 1) {

                // Set to the first day of the month

                today &= (~0x0ff);

                today |= 1;

                mo++;

                if (mo > 12) {

                        // Set to the first month of the year

                        today &= ~(0x0ff00);

                        today |= 0x0100;

                        // Increment the year

                        today += 0x010000;

                        if ((today & 0x0f0000)>=0x0a0000) {

                                today += 0x060000;

                                if ((today& 0x0f00000)>= 0x0a00000) {

                                        today += 0x0600000;

                                        if ((today & 0x0f000000)>= 0x0a000000) {

                                                today += 0x06000000;

                                                if ((today & 0x0f0000000)>=0x0a0000000)

                                                        today += 0x060000000;

                                        }

                                }

                        }

                }

        } else {

                today += 1;

                if ((today & 0x0f)>=0x0a)

                        today += 0x06;

        }

        return today;

}

#ifdef  ZIPOS

#include "board.h"

#include "../zipos/ktraps.h"

#include "../zipos/swint.h"

void rtctask(void) {

        // IOSPACE *sys = (IOSPACE *)IOADDR;

        rtcdate = 0x20160504;

        rtcclock = 0;

        while(1) {

                unsigned event = wait(SWINT_CLOCK,-1);

                if (event&SWINT_CLOCK) {

                        unsigned v, nextevent = SWINT_PPS;

                        semget(SEMCLOCK);

                        rtcclock = v = rtcnext(rtcclock);

                        semput(SEMCLOCK);

#ifdef  SWINT_ALARM

                        if (v == rtcalarm)

                                nextevent |= SWINT_ALARM;

#endif

                        if (v == 0) {

                                semget(SEMDATE);

                                rtcdate = rtcdatenext(rtcdate);

                                semput(SEMDATE);

#ifdef  SWINT_PPD

                                nextevent |= SWINT_PPD;

#endif

                        } post(nextevent);

                }

        }

}

#endif