📄 hp_sdc_rtc.c
字号:
/* * HP i8042 SDC + MSM-58321 BBRTC driver. * * Copyright (c) 2001 Brian S. Julin * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions, and the following disclaimer, * without modification. * 2. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * Alternatively, this software may be distributed under the terms of the * GNU General Public License ("GPL"). * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * * References: * System Device Controller Microprocessor Firmware Theory of Operation * for Part Number 1820-4784 Revision B. Dwg No. A-1820-4784-2 * efirtc.c by Stephane Eranian/Hewlett Packard * */#include <linux/hp_sdc.h>#include <linux/errno.h>#include <linux/types.h>#include <linux/init.h>#include <linux/module.h>#include <linux/time.h>#include <linux/miscdevice.h>#include <linux/proc_fs.h>#include <linux/poll.h>#include <linux/rtc.h>MODULE_AUTHOR("Brian S. Julin <bri@calyx.com>");MODULE_DESCRIPTION("HP i8042 SDC + MSM-58321 RTC Driver");MODULE_LICENSE("Dual BSD/GPL");#define RTC_VERSION "1.10d"static unsigned long epoch = 2000;static struct semaphore i8042tregs;static hp_sdc_irqhook hp_sdc_rtc_isr;static struct fasync_struct *hp_sdc_rtc_async_queue;static DECLARE_WAIT_QUEUE_HEAD(hp_sdc_rtc_wait);static loff_t hp_sdc_rtc_llseek(struct file *file, loff_t offset, int origin);static ssize_t hp_sdc_rtc_read(struct file *file, char *buf, size_t count, loff_t *ppos);static int hp_sdc_rtc_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg);static unsigned int hp_sdc_rtc_poll(struct file *file, poll_table *wait);static int hp_sdc_rtc_open(struct inode *inode, struct file *file);static int hp_sdc_rtc_release(struct inode *inode, struct file *file);static int hp_sdc_rtc_fasync (int fd, struct file *filp, int on);static int hp_sdc_rtc_read_proc(char *page, char **start, off_t off, int count, int *eof, void *data);static void hp_sdc_rtc_isr (int irq, void *dev_id, uint8_t status, uint8_t data) { return;}static int hp_sdc_rtc_do_read_bbrtc (struct rtc_time *rtctm){ struct semaphore tsem; hp_sdc_transaction t; uint8_t tseq[91]; int i; i = 0; while (i < 91) { tseq[i++] = HP_SDC_ACT_DATAREG | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN; tseq[i++] = 0x01; /* write i8042[0x70] */ tseq[i] = i / 7; /* BBRTC reg address */ i++; tseq[i++] = HP_SDC_CMD_DO_RTCR; /* Trigger command */ tseq[i++] = 2; /* expect 1 stat/dat pair back. */ i++; i++; /* buffer for stat/dat pair */ } tseq[84] |= HP_SDC_ACT_SEMAPHORE; t.endidx = 91; t.seq = tseq; t.act.semaphore = &tsem; init_MUTEX_LOCKED(&tsem); if (hp_sdc_enqueue_transaction(&t)) return -1; down_interruptible(&tsem); /* Put ourselves to sleep for results. */ /* Check for nonpresence of BBRTC */ if (!((tseq[83] | tseq[90] | tseq[69] | tseq[76] | tseq[55] | tseq[62] | tseq[34] | tseq[41] | tseq[20] | tseq[27] | tseq[6] | tseq[13]) & 0x0f)) return -1; memset(rtctm, 0, sizeof(struct rtc_time)); rtctm->tm_year = (tseq[83] & 0x0f) + (tseq[90] & 0x0f) * 10; rtctm->tm_mon = (tseq[69] & 0x0f) + (tseq[76] & 0x0f) * 10; rtctm->tm_mday = (tseq[55] & 0x0f) + (tseq[62] & 0x0f) * 10; rtctm->tm_wday = (tseq[48] & 0x0f); rtctm->tm_hour = (tseq[34] & 0x0f) + (tseq[41] & 0x0f) * 10; rtctm->tm_min = (tseq[20] & 0x0f) + (tseq[27] & 0x0f) * 10; rtctm->tm_sec = (tseq[6] & 0x0f) + (tseq[13] & 0x0f) * 10; return 0;}static int hp_sdc_rtc_read_bbrtc (struct rtc_time *rtctm){ struct rtc_time tm, tm_last; int i = 0; /* MSM-58321 has no read latch, so must read twice and compare. */ if (hp_sdc_rtc_do_read_bbrtc(&tm_last)) return -1; if (hp_sdc_rtc_do_read_bbrtc(&tm)) return -1; while (memcmp(&tm, &tm_last, sizeof(struct rtc_time))) { if (i++ > 4) return -1; memcpy(&tm_last, &tm, sizeof(struct rtc_time)); if (hp_sdc_rtc_do_read_bbrtc(&tm)) return -1; } memcpy(rtctm, &tm, sizeof(struct rtc_time)); return 0;}static int64_t hp_sdc_rtc_read_i8042timer (uint8_t loadcmd, int numreg){ hp_sdc_transaction t; uint8_t tseq[26] = { HP_SDC_ACT_PRECMD | HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN, 0, HP_SDC_CMD_READ_T1, 2, 0, 0, HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN, HP_SDC_CMD_READ_T2, 2, 0, 0, HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN, HP_SDC_CMD_READ_T3, 2, 0, 0, HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN, HP_SDC_CMD_READ_T4, 2, 0, 0, HP_SDC_ACT_POSTCMD | HP_SDC_ACT_DATAIN, HP_SDC_CMD_READ_T5, 2, 0, 0 }; t.endidx = numreg * 5; tseq[1] = loadcmd; tseq[t.endidx - 4] |= HP_SDC_ACT_SEMAPHORE; /* numreg assumed > 1 */ t.seq = tseq; t.act.semaphore = &i8042tregs; down_interruptible(&i8042tregs); /* Sleep if output regs in use. */ if (hp_sdc_enqueue_transaction(&t)) return -1; down_interruptible(&i8042tregs); /* Sleep until results come back. */ up(&i8042tregs); return (tseq[5] | ((uint64_t)(tseq[10]) << 8) | ((uint64_t)(tseq[15]) << 16) | ((uint64_t)(tseq[20]) << 24) | ((uint64_t)(tseq[25]) << 32));}/* Read the i8042 real-time clock */static inline int hp_sdc_rtc_read_rt(struct timeval *res) { int64_t raw; uint32_t tenms; unsigned int days; raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_RT, 5); if (raw < 0) return -1; tenms = (uint32_t)raw & 0xffffff; days = (unsigned int)(raw >> 24) & 0xffff; res->tv_usec = (suseconds_t)(tenms % 100) * 10000; res->tv_sec = (time_t)(tenms / 100) + days * 86400; return 0;}/* Read the i8042 fast handshake timer */static inline int hp_sdc_rtc_read_fhs(struct timeval *res) { uint64_t raw; unsigned int tenms; raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_FHS, 2); if (raw < 0) return -1; tenms = (unsigned int)raw & 0xffff; res->tv_usec = (suseconds_t)(tenms % 100) * 10000; res->tv_sec = (time_t)(tenms / 100); return 0;}/* Read the i8042 match timer (a.k.a. alarm) */static inline int hp_sdc_rtc_read_mt(struct timeval *res) { int64_t raw; uint32_t tenms; raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_MT, 3); if (raw < 0) return -1; tenms = (uint32_t)raw & 0xffffff; res->tv_usec = (suseconds_t)(tenms % 100) * 10000; res->tv_sec = (time_t)(tenms / 100); return 0;}/* Read the i8042 delay timer */static inline int hp_sdc_rtc_read_dt(struct timeval *res) { int64_t raw; uint32_t tenms; raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_DT, 3); if (raw < 0) return -1; tenms = (uint32_t)raw & 0xffffff; res->tv_usec = (suseconds_t)(tenms % 100) * 10000; res->tv_sec = (time_t)(tenms / 100); return 0;}/* Read the i8042 cycle timer (a.k.a. periodic) */static inline int hp_sdc_rtc_read_ct(struct timeval *res) { int64_t raw; uint32_t tenms; raw = hp_sdc_rtc_read_i8042timer(HP_SDC_CMD_LOAD_CT, 3); if (raw < 0) return -1; tenms = (uint32_t)raw & 0xffffff; res->tv_usec = (suseconds_t)(tenms % 100) * 10000; res->tv_sec = (time_t)(tenms / 100); return 0;}/* Set the i8042 real-time clock */static int hp_sdc_rtc_set_rt (struct timeval *setto){ uint32_t tenms; unsigned int days; hp_sdc_transaction t; uint8_t tseq[11] = { HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT, HP_SDC_CMD_SET_RTMS, 3, 0, 0, 0, HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT, HP_SDC_CMD_SET_RTD, 2, 0, 0 }; t.endidx = 10; if (0xffff < setto->tv_sec / 86400) return -1; days = setto->tv_sec / 86400; if (0xffff < setto->tv_usec / 1000000 / 86400) return -1; days += ((setto->tv_sec % 86400) + setto->tv_usec / 1000000) / 86400; if (days > 0xffff) return -1; if (0xffffff < setto->tv_sec) return -1; tenms = setto->tv_sec * 100; if (0xffffff < setto->tv_usec / 10000) return -1; tenms += setto->tv_usec / 10000; if (tenms > 0xffffff) return -1; tseq[3] = (uint8_t)(tenms & 0xff); tseq[4] = (uint8_t)((tenms >> 8) & 0xff); tseq[5] = (uint8_t)((tenms >> 16) & 0xff); tseq[9] = (uint8_t)(days & 0xff); tseq[10] = (uint8_t)((days >> 8) & 0xff); t.seq = tseq; if (hp_sdc_enqueue_transaction(&t)) return -1; return 0;}/* Set the i8042 fast handshake timer */static int hp_sdc_rtc_set_fhs (struct timeval *setto){ uint32_t tenms; hp_sdc_transaction t; uint8_t tseq[5] = { HP_SDC_ACT_PRECMD | HP_SDC_ACT_DATAOUT, HP_SDC_CMD_SET_FHS, 2, 0, 0 }; t.endidx = 4; if (0xffff < setto->tv_sec) return -1; tenms = setto->tv_sec * 100; if (0xffff < setto->tv_usec / 10000) return -1; tenms += setto->tv_usec / 10000; if (tenms > 0xffff) return -1; tseq[3] = (uint8_t)(tenms & 0xff); tseq[4] = (uint8_t)((tenms >> 8) & 0xff); t.seq = tseq; if (hp_sdc_enqueue_transaction(&t)) return -1; return 0;}/* Set the i8042 match timer (a.k.a. alarm) */#define hp_sdc_rtc_set_mt (setto) \ hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_MT)/* Set the i8042 delay timer */#define hp_sdc_rtc_set_dt (setto) \ hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_DT)/* Set the i8042 cycle timer (a.k.a. periodic) */#define hp_sdc_rtc_set_ct (setto) \ hp_sdc_rtc_set_i8042timer(setto, HP_SDC_CMD_SET_CT)/* Set one of the i8042 3-byte wide timers */static int hp_sdc_rtc_set_i8042timer (struct timeval *setto, uint8_t setcmd){ uint32_t tenms; hp_sdc_transaction t;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -