[BACK]Return to cpufreq.c CVS log [TXT][DIR] Up to [local] / prex / dev / power

Annotation of prex/dev/power/cpufreq.c, Revision 1.1

1.1     ! nbrk        1: /*-
        !             2:  * Copyright (c) 2007-2008, Kohsuke Ohtani
        !             3:  * All rights reserved.
        !             4:  *
        !             5:  * Redistribution and use in source and binary forms, with or without
        !             6:  * modification, are permitted provided that the following conditions
        !             7:  * are met:
        !             8:  * 1. Redistributions of source code must retain the above copyright
        !             9:  *    notice, this list of conditions and the following disclaimer.
        !            10:  * 2. Redistributions in binary form must reproduce the above copyright
        !            11:  *    notice, this list of conditions and the following disclaimer in the
        !            12:  *    documentation and/or other materials provided with the distribution.
        !            13:  * 3. Neither the name of the author nor the names of any co-contributors
        !            14:  *    may be used to endorse or promote products derived from this software
        !            15:  *    without specific prior written permission.
        !            16:  *
        !            17:  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
        !            18:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
        !            19:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
        !            20:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
        !            21:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
        !            22:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
        !            23:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
        !            24:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
        !            25:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
        !            26:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
        !            27:  * SUCH DAMAGE.
        !            28:  */
        !            29:
        !            30: /*
        !            31:  * cpufreq.c - CPU frequency control
        !            32:  */
        !            33:
        !            34: /*
        !            35:  * Dynamic voltage scaling (DVS)
        !            36:  *
        !            37:  * DVS is widely used with mobile systems to save the processor
        !            38:  * power consumption, with minimum impact on performance.
        !            39:  * The basic idea is come from the fact the power consumption is
        !            40:  * proportional to V^2 x f, where V is voltage and f is frequency.
        !            41:  * Since processor does not always require the full performance,
        !            42:  * we can reduce power consumption by lowering voltage and frequeceny.
        !            43:  */
        !            44:
        !            45: #include <sys/ioctl.h>
        !            46: #include <driver.h>
        !            47: #include <pm.h>
        !            48: #include <cpu.h>
        !            49: #include <cpufreq.h>
        !            50:
        !            51: /* #define DEBUG_CPUFREQ 1 */
        !            52:
        !            53: #ifdef DEBUG_CPUFREQ
        !            54: #define DPRINTF(a) printf a
        !            55: #else
        !            56: #define DPRINTF(a)
        !            57: #endif
        !            58:
        !            59: /*
        !            60:  * DVS parameters
        !            61:  */
        !            62: #define INTERVAL_MSEC          50
        !            63: #define INTERVAL_TICK          msec_to_tick(INTERVAL_MSEC)
        !            64: #define WEIGHT                 20
        !            65:
        !            66: static int cpufreq_open(device_t dev, int mode);
        !            67: static int cpufreq_ioctl(device_t dev, u_long cmd, void *arg);
        !            68: static int cpufreq_close(device_t dev);
        !            69: static int cpufreq_init(void);
        !            70:
        !            71: /*
        !            72:  * Driver structure
        !            73:  */
        !            74: struct driver cpufreq_drv = {
        !            75:        /* name */      "CPU Frequency Control",
        !            76:        /* order */     3,              /* Must larger than pm driver */
        !            77:        /* init */      cpufreq_init,
        !            78: };
        !            79:
        !            80: /*
        !            81:  * Device I/O table
        !            82:  */
        !            83: static struct devio cpufreq_io = {
        !            84:        /* open */      cpufreq_open,
        !            85:        /* close */     cpufreq_close,
        !            86:        /* read */      NULL,
        !            87:        /* write */     NULL,
        !            88:        /* ioctl */     cpufreq_ioctl,
        !            89:        /* event */     NULL,
        !            90: };
        !            91:
        !            92: static device_t cpufreq_dev;   /* Device object */
        !            93:
        !            94: static int cpufreq_policy;     /* Frequecy control policy */
        !            95:
        !            96: static struct dpc dvs_dpc;     /* DPC object */
        !            97:
        !            98: static int dvs_capable;                /* True if the system has dvs capability */
        !            99: static int dvs_enabled;                /* True if dvs is enabled */
        !           100:
        !           101: static int cur_speed;          /* Current CPU speed (%) */
        !           102: static int max_speed;          /* Maximum CPU speed (%) */
        !           103: static int min_speed;          /* Minimum CPU speed (%) */
        !           104:
        !           105: static int run_cycles;   /* The non-idle CPU cycles in the last interval */
        !           106: static int idle_cycles;          /* The idle CPU cycles in the last interval */
        !           107: static int excess_cycles; /* The cycles left over from the last interval */
        !           108:
        !           109: static int avg_workload;       /* Average workload */
        !           110: static int avg_deadline;       /* Average deadline */
        !           111:
        !           112: static u_long elapsed_ticks;
        !           113:
        !           114:
        !           115: /*
        !           116:  * Predict CPU speed.
        !           117:  *
        !           118:  * DVS Algorithm: Weiser Style
        !           119:  *
        !           120:  *  If the utilization prediction x is high (over 70%), increase the
        !           121:  *  speed by 20% of the maximum speed. If the utilization prediction
        !           122:  *  is low (under 50%), decrease the speed by (60 - x)% of the
        !           123:  *  maximum speed.
        !           124:  *
        !           125:  *  excess_cycles is defined as the number of uncompleted run cycles
        !           126:  *  from the last interval. For example, if we find 70% activity
        !           127:  *  when runnig at full speed, and their processor speed was set to
        !           128:  *  50% during that interval, excess_cycles is set to 20%. This
        !           129:  *  value (20%) is used to calculate the processor speed in the next
        !           130:  *  interval.
        !           131:  *
        !           132:  * Refernce:
        !           133:  *   M.Weiser, B.Welch, A.Demers, and S.Shenker,
        !           134:  *   "Scheduling for Reduced CPU Energy", In Proceedings of the
        !           135:  *   1st Symposium on Operating Systems Design and Implementation,
        !           136:  *   pages 13-23, November 1994.
        !           137:  */
        !           138: static int
        !           139: predict_cpu_speed(int speed)
        !           140: {
        !           141:        int next_excess;
        !           142:        int run_percent;
        !           143:        int newspeed = speed;
        !           144:
        !           145:        run_cycles += excess_cycles;
        !           146:        run_percent = (run_cycles * 100) / (idle_cycles + run_cycles);
        !           147:
        !           148:        next_excess = run_cycles - speed * (run_cycles + idle_cycles) / 100;
        !           149:        if (next_excess < 0)
        !           150:                next_excess = 0;
        !           151:
        !           152:        if (excess_cycles > idle_cycles)
        !           153:                newspeed = 100;
        !           154:        else if (run_percent > 70)
        !           155:                newspeed = speed + 20;
        !           156:        else if (run_percent < 50)
        !           157:                newspeed = speed - (60 - run_percent);
        !           158:
        !           159:        if (newspeed > max_speed)
        !           160:                newspeed = max_speed;
        !           161:        if (newspeed < min_speed)
        !           162:                newspeed = min_speed;
        !           163:
        !           164:        DPRINTF(("DVS: run_percent=%d next_excess=%d newspeed=%d\n\n",
        !           165:                 run_percent, next_excess, newspeed));
        !           166:
        !           167:        excess_cycles = next_excess;
        !           168:        return newspeed;
        !           169: }
        !           170:
        !           171: /*
        !           172:  * Predict max CPU speed.
        !           173:  *
        !           174:  * DVS Algorithm: AVG<3>
        !           175:  *
        !           176:  *  Computes an exponentially moving average of the previous intervals.
        !           177:  *  <wight> is the relative weighting of past intervals relative to
        !           178:  *  the current interval.
        !           179:  *
        !           180:  *   predict = (weight x current + past) / (weight + 1)
        !           181:  *
        !           182:  * Refernce:
        !           183:  *   K.Govil, E.Chan, H.Wasserman,
        !           184:  *   "Comparing Algorithm for Dynamic Speed-Setting of a Low-Power CPU".
        !           185:  *   Proc. 1st Int'l Conference on Mobile Computing and Networking,
        !           186:  *   Nov 1995.
        !           187:  */
        !           188: static int
        !           189: predict_max_speed(int speed)
        !           190: {
        !           191:        int new_workload;
        !           192:        int new_deadline;
        !           193:        int newspeed;
        !           194:
        !           195:        new_workload = run_cycles * speed;
        !           196:        new_deadline = (run_cycles + idle_cycles) * speed;
        !           197:
        !           198:        avg_workload = (avg_workload * WEIGHT + new_workload) / (WEIGHT + 1);
        !           199:        avg_deadline = (avg_deadline * WEIGHT + new_deadline) / (WEIGHT + 1);
        !           200:
        !           201:        newspeed = avg_workload * 100 / avg_deadline;
        !           202:
        !           203:        DPRINTF(("DVS: new_workload=%u new_deadline=%u\n",
        !           204:                 new_workload, new_deadline));
        !           205:        DPRINTF(("DVS: avg_workload=%u avg_deadline=%u\n",
        !           206:                 avg_workload, avg_deadline));
        !           207:        return newspeed;
        !           208: }
        !           209:
        !           210: /*
        !           211:  * DPC routine to set CPU speed.
        !           212:  *
        !           213:  * This is kicked by dvs_tick() if it needed.
        !           214:  */
        !           215: static void
        !           216: dpc_adjust_speed(void *arg)
        !           217: {
        !           218:        int newspeed = (int)arg;
        !           219:
        !           220:        DPRINTF(("DVS: new speed=%d\n", newspeed));
        !           221:        cpu_setperf(newspeed);
        !           222:        cur_speed = cpu_getperf();
        !           223: }
        !           224:
        !           225: /*
        !           226:  * Timer hook routine called by tick handler.
        !           227:  */
        !           228: static void
        !           229: dvs_tick(int idle)
        !           230: {
        !           231:        int newspeed;
        !           232:
        !           233:        elapsed_ticks++;
        !           234:        if (idle)
        !           235:                idle_cycles++;
        !           236:        else
        !           237:                run_cycles++;
        !           238:
        !           239:        if (elapsed_ticks < INTERVAL_TICK)
        !           240:                return;
        !           241:
        !           242:        /* Predict max CPU speed */
        !           243:        max_speed = predict_max_speed(cur_speed);
        !           244:
        !           245:        DPRINTF(("DVS: run_cycles=%d idle_cycles=%d cur_speed=%d "
        !           246:                 "max_speed=%d\n",
        !           247:                 run_cycles, idle_cycles, cur_speed, max_speed));
        !           248:        /*
        !           249:         * Predict next CPU speed
        !           250:         */
        !           251:        newspeed = predict_cpu_speed(cur_speed);
        !           252:        if (newspeed != cur_speed) {
        !           253:                sched_dpc(&dvs_dpc, &dpc_adjust_speed, (void *)newspeed);
        !           254:        }
        !           255:        run_cycles = 0;
        !           256:        idle_cycles = 0;
        !           257:        elapsed_ticks = 0;
        !           258: }
        !           259:
        !           260: /*
        !           261:  * Enable DVS operation
        !           262:  */
        !           263: static void
        !           264: dvs_enable(void)
        !           265: {
        !           266:
        !           267:        if (!dvs_capable)
        !           268:                return;
        !           269:
        !           270:        run_cycles = 0;
        !           271:        idle_cycles = 0;
        !           272:        elapsed_ticks = 0;
        !           273:
        !           274:        max_speed = 100;        /* max 100% */
        !           275:        min_speed = 5;          /* min   5% */
        !           276:        cur_speed = cpu_getperf();
        !           277:
        !           278:        timer_hook(dvs_tick);
        !           279:        dvs_enabled = 1;
        !           280: }
        !           281:
        !           282: /*
        !           283:  * Disable DVS operation
        !           284:  */
        !           285: static void
        !           286: dvs_disable(void)
        !           287: {
        !           288:
        !           289:        if (!dvs_capable)
        !           290:                return;
        !           291:
        !           292:        timer_hook(NULL);
        !           293:
        !           294:        /* Set CPU speed to 100% */
        !           295:        cpu_setperf(100);
        !           296:        dvs_enabled = 0;
        !           297: }
        !           298:
        !           299: static int
        !           300: cpufreq_open(device_t dev, int mode)
        !           301: {
        !           302:
        !           303:        return 0;
        !           304: }
        !           305:
        !           306: static int
        !           307: cpufreq_close(device_t dev)
        !           308: {
        !           309:
        !           310:        return 0;
        !           311: }
        !           312:
        !           313: static int
        !           314: cpufreq_ioctl(device_t dev, u_long cmd, void *arg)
        !           315: {
        !           316:
        !           317:        return 0;
        !           318: }
        !           319:
        !           320: void
        !           321: cpufreq_setpolicy(int policy)
        !           322: {
        !           323:
        !           324:        switch (cpufreq_policy) {
        !           325:        case CPUFREQ_ONDEMAND:
        !           326:                if (policy == PM_POWERSAVE)
        !           327:                        dvs_enable();
        !           328:                else
        !           329:                        dvs_disable();
        !           330:
        !           331:                break;
        !           332:        case CPUFREQ_MAXSPEED:
        !           333:                break;
        !           334:        case CPUFREQ_MINSPEED:
        !           335:                break;
        !           336:        }
        !           337: }
        !           338:
        !           339: static int
        !           340: cpufreq_init(void)
        !           341: {
        !           342:        int policy;
        !           343:
        !           344:        if (cpu_initperf())
        !           345:                return -1;
        !           346:
        !           347:        /* Create device object */
        !           348:        cpufreq_dev = device_create(&cpufreq_io, "cpufreq", DF_CHR);
        !           349:        ASSERT(cpufreq_dev);
        !           350:
        !           351:        dvs_capable = 1;
        !           352:
        !           353:        policy = pm_getpolicy();
        !           354:        if (policy == PM_POWERSAVE)
        !           355:                dvs_enable();
        !           356:        return 0;
        !           357: }
        !           358:

CVSweb