Return to sapmc.c CVS log

Up to [local] / prex-old / dev / arm / cats

Annotation of prex-old/dev/arm/cats/sapmc.c, Revision 1.1

1.1     ! nbrk        1: /*
        !             2:  * $Id$
        !             3:  */
        !             4: /*
        !             5:  * StrongARM 11x0 Power Management Controller.
        !             6:  */
        !             7: #include <driver.h>
        !             8: #include <sys/ioctl.h>
        !             9:
        !            10: #include "sapmc_reg.h"
        !            11:
        !            12: int sapmc_init(void);
        !            13: int sapmc_ioctl(device_t, int, u_long);
        !            14: void   sapmc_setfreq(int mode);
        !            15: uint32_t       sapmc_getfreq(void);
        !            16:
        !            17: /*
        !            18:  * Driver structure
        !            19:  */
        !            20: struct driver sapmc_drv = {
        !            21:     /* name */ "SA-11x0 PMC",
        !            22:     /* order */ 1,
        !            23:     /* init */sapmc_init,
        !            24: };
        !            25:
        !            26: struct devio sapmc_io = {
        !            27:     /* open */  NULL,
        !            28:     /* close */ NULL,
        !            29:     /* read */  NULL,
        !            30:     /* write */ NULL,
        !            31:     /* ioctl */ sapmc_ioctl,
        !            32:     /* event */ NULL,
        !            33: };
        !            34:
        !            35: device_t sapmc_dev;
        !            36:
        !            37:
        !            38: /*
        !            39:  * XXX PLL controlled Core Clock Frequencies with 3686400 Hz oscillator.
        !            40:  */
        !            41: #define SAPMC_NFREQMODES       12
        !            42:
        !            43: uint32_t       sapmc_ccfmodes[SAPMC_NFREQMODES] = {
        !            44:        /* 0 */ 59000000,
        !            45:        /* 1 */ 73700000,
        !            46:        /* 2 */ 88500000,
        !            47:        /* 3 */ 103200000,
        !            48:        118000000,
        !            49:        132700000,
        !            50:        147500000,
        !            51:        162200000,
        !            52:        176900000,
        !            53:        191700000,
        !            54:        206400000,
        !            55:        221200000
        !            56: };
        !            57:
        !            58: int
        !            59: sapmc_init(void)
        !            60: {
        !            61:        /* register device */
        !            62:        sapmc_dev = device_create(&sapmc_io, "sapmc", DF_CHR);
        !            63:
        !            64:        return(0);
        !            65: }
        !            66:
        !            67:
        !            68: int
        !            69: sapmc_ioctl(device_t dev, int cmd, u_long arg)
        !            70: {
        !            71:        /*
        !            72:         * ioctl() arg is a frequency in MHz.
        !            73:         */
        !            74:        uint32_t        freq;
        !            75:
        !            76:        switch(cmd) {
        !            77:                case CPUIOC_SET_FREQ:
        !            78:                        umem_copyin((uint32_t *)arg, &freq, sizeof(uint32_t));
        !            79:                        if (freq > SAPMC_NFREQMODES)
        !            80:                                return(EINVAL);
        !            81:
        !            82:                        sapmc_setfreq(freq);
        !            83:                        break;
        !            84:
        !            85:                case CPUIOC_GET_FREQ:
        !            86:                        freq = sapmc_getfreq();
        !            87:                        umem_copyout(&freq, (uint32_t *)arg, sizeof(uint32_t));
        !            88:                        break;
        !            89:        }
        !            90:
        !            91:        return(0);
        !            92: }
        !            93:
        !            94:
        !            95: void
        !            96: sapmc_setfreq(int mode)
        !            97: {
        !            98:        *(volatile uint32_t *)(SAPMC_BASE + SAPMC_PPCR) = (mode & CCF);
        !            99: }
        !           100:
        !           101:
        !           102: uint32_t
        !           103: sapmc_getfreq(void)
        !           104: {
        !           105:        int mode;
        !           106:
        !           107:        mode = *(volatile uint32_t *)(SAPMC_BASE + SAPMC_PPCR);
        !           108:
        !           109:        return(sapmc_ccfmodes[mode]);
        !           110: }