Current Path : /usr/src/sys/contrib/octeon-sdk/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //usr/src/sys/contrib/octeon-sdk/cvmx-cn3010-evb-hs5.c |
/***********************license start*************** * Copyright (c) 2003-2010 Cavium Networks (support@cavium.com). All rights * reserved. * * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are * met: * * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * * Neither the name of Cavium Networks nor the names of * its contributors may be used to endorse or promote products * derived from this software without specific prior written * permission. * This Software, including technical data, may be subject to U.S. export control * laws, including the U.S. Export Administration Act and its associated * regulations, and may be subject to export or import regulations in other * countries. * TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS" * AND WITH ALL FAULTS AND CAVIUM NETWORKS MAKES NO PROMISES, REPRESENTATIONS OR * WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH RESPECT TO * THE SOFTWARE, INCLUDING ITS CONDITION, ITS CONFORMITY TO ANY REPRESENTATION OR * DESCRIPTION, OR THE EXISTENCE OF ANY LATENT OR PATENT DEFECTS, AND CAVIUM * SPECIFICALLY DISCLAIMS ALL IMPLIED (IF ANY) WARRANTIES OF TITLE, * MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR PURPOSE, LACK OF * VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET POSSESSION OR * CORRESPONDENCE TO DESCRIPTION. THE ENTIRE RISK ARISING OUT OF USE OR * PERFORMANCE OF THE SOFTWARE LIES WITH YOU. ***********************license end**************************************/ /** * @file * * Interface to the EBH-30xx specific devices * * <hr>$Revision: 49448 $<hr> * */ #include <time.h> #include "cvmx-config.h" #include "cvmx.h" #include "cvmx-sysinfo.h" #include "cvmx-cn3010-evb-hs5.h" #include "cvmx-twsi.h" static inline uint8_t bin2bcd(uint8_t bin) { return (bin / 10) << 4 | (bin % 10); } static inline uint8_t bcd2bin(uint8_t bcd) { return (bcd >> 4) * 10 + (bcd & 0xf); } #define TM_CHECK(_expr, _msg) \ do { \ if (_expr) { \ cvmx_dprintf("Warning: RTC has invalid %s field\n", (_msg)); \ rc = -1; \ } \ } while(0); static int validate_tm_struct(struct tm * tms) { int rc = 0; if (!tms) return -1; TM_CHECK(tms->tm_sec < 0 || tms->tm_sec > 60, "second"); /* + Leap sec */ TM_CHECK(tms->tm_min < 0 || tms->tm_min > 59, "minute"); TM_CHECK(tms->tm_hour < 0 || tms->tm_hour > 23, "hour"); TM_CHECK(tms->tm_mday < 1 || tms->tm_mday > 31, "day"); TM_CHECK(tms->tm_wday < 0 || tms->tm_wday > 6, "day of week"); TM_CHECK(tms->tm_mon < 0 || tms->tm_mon > 11, "month"); TM_CHECK(tms->tm_year < 0 || tms->tm_year > 200,"year"); return rc; } /* * Board-specifc RTC read * Time is expressed in seconds from epoch (Jan 1 1970 at 00:00:00 UTC) * and converted internally to calendar format. */ uint32_t cvmx_rtc_ds1337_read(void) { int i, retry; uint32_t time; uint8_t reg[8]; uint8_t sec; struct tm tms; memset(®, 0, sizeof(reg)); memset(&tms, 0, sizeof(struct tm)); for(retry=0; retry<2; retry++) { /* Lockless read: detects the infrequent roll-over and retries */ reg[0] = cvmx_twsi_read8(CVMX_RTC_DS1337_ADDR, 0x0); for(i=1; i<7; i++) reg[i] = cvmx_twsi_read8_cur_addr(CVMX_RTC_DS1337_ADDR); sec = cvmx_twsi_read8(CVMX_RTC_DS1337_ADDR, 0x0); if ((sec & 0xf) == (reg[0] & 0xf)) break; /* Time did not roll-over, value is correct */ } tms.tm_sec = bcd2bin(reg[0] & 0x7f); tms.tm_min = bcd2bin(reg[1] & 0x7f); tms.tm_hour = bcd2bin(reg[2] & 0x3f); if ((reg[2] & 0x40) && (reg[2] & 0x20)) /* AM/PM format and is PM time */ { tms.tm_hour = (tms.tm_hour + 12) % 24; } tms.tm_wday = (reg[3] & 0x7) - 1; /* Day of week field is 0..6 */ tms.tm_mday = bcd2bin(reg[4] & 0x3f); tms.tm_mon = bcd2bin(reg[5] & 0x1f) - 1; /* Month field is 0..11 */ tms.tm_year = ((reg[5] & 0x80) ? 100 : 0) + bcd2bin(reg[6]); if (validate_tm_struct(&tms)) cvmx_dprintf("Warning: RTC calendar is not configured properly\n"); time = mktime(&tms); return time; } /* * Board-specific RTC write * Time returned is in seconds from epoch (Jan 1 1970 at 00:00:00 UTC) */ int cvmx_rtc_ds1337_write(uint32_t time) { int i, rc, retry; struct tm tms; uint8_t reg[8]; uint8_t sec; time_t time_from_epoch = time; localtime_r(&time_from_epoch, &tms); if (validate_tm_struct(&tms)) { cvmx_dprintf("Error: RTC was passed wrong calendar values, write failed\n"); goto tm_invalid; } reg[0] = bin2bcd(tms.tm_sec); reg[1] = bin2bcd(tms.tm_min); reg[2] = bin2bcd(tms.tm_hour); /* Force 0..23 format even if using AM/PM */ reg[3] = bin2bcd(tms.tm_wday + 1); reg[4] = bin2bcd(tms.tm_mday); reg[5] = bin2bcd(tms.tm_mon + 1); if (tms.tm_year >= 100) /* Set century bit*/ { reg[5] |= 0x80; } reg[6] = bin2bcd(tms.tm_year % 100); /* Lockless write: detects the infrequent roll-over and retries */ for(retry=0; retry<2; retry++) { rc = 0; for(i=0; i<7; i++) { rc |= cvmx_twsi_write8(CVMX_RTC_DS1337_ADDR, i, reg[i]); } sec = cvmx_twsi_read8(CVMX_RTC_DS1337_ADDR, 0x0); if ((sec & 0xf) == (reg[0] & 0xf)) break; /* Time did not roll-over, value is correct */ } return (rc ? -1 : 0); tm_invalid: return -1; } #ifdef CVMX_RTC_DEBUG void cvmx_rtc_ds1337_dump_state(void) { int i = 0; printf("RTC:\n"); printf("%d : %02X ", i, cvmx_twsi_read8(CVMX_RTC_DS1337_ADDR, 0x0)); for(i=1; i<16; i++) { printf("%02X ", cvmx_twsi_read8_cur_addr(CVMX_RTC_DS1337_ADDR)); } printf("\n"); } #endif /* CVMX_RTC_DEBUG */