Contiki 2.6
|
00001 /* 00002 * Copyright (c) 2005, Swedish Institute of Computer Science 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions 00007 * are met: 00008 * 1. Redistributions of source code must retain the above copyright 00009 * notice, this list of conditions and the following disclaimer. 00010 * 2. Redistributions in binary form must reproduce the above copyright 00011 * notice, this list of conditions and the following disclaimer in the 00012 * documentation and/or other materials provided with the distribution. 00013 * 3. Neither the name of the Institute nor the names of its contributors 00014 * may be used to endorse or promote products derived from this software 00015 * without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND 00018 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00019 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00020 * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE 00021 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 00022 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 00023 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 00024 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00025 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 00026 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00027 * SUCH DAMAGE. 00028 * 00029 * This file is part of the Contiki operating system. 00030 * 00031 * @(#)$Id: vib-sensor.c,v 1.5 2010/02/08 00:00:45 nifi Exp $ 00032 */ 00033 00034 #include "dev/vib-sensor.h" 00035 #include "dev/irq.h" 00036 #include "dev/hwconf.h" 00037 00038 const struct sensors_sensor vib_sensor; 00039 00040 static unsigned int vib; 00041 00042 #define VIB_IRQ() 4 00043 HWCONF_PIN(VIB, 1, VIB_IRQ()); 00044 HWCONF_IRQ(VIB, 1, VIB_IRQ()); 00045 00046 /*---------------------------------------------------------------------------*/ 00047 static int 00048 irq(void) 00049 { 00050 ++vib; 00051 sensors_changed(&vib_sensor); 00052 return 1; 00053 } 00054 /*---------------------------------------------------------------------------*/ 00055 static int 00056 value(int type) 00057 { 00058 return vib; 00059 } 00060 /*---------------------------------------------------------------------------*/ 00061 static int 00062 configure(int type, int value) 00063 { 00064 switch(type) { 00065 case SENSORS_HW_INIT: 00066 vib = 0; 00067 VIB_SELECT(); 00068 VIB_MAKE_INPUT(); 00069 return 1; 00070 case SENSORS_ACTIVE: 00071 if(value) { 00072 if(!VIB_IRQ_ENABLED()) { 00073 irq_port1_activate(VIB_IRQ(), irq); 00074 VIB_ENABLE_IRQ(); 00075 } 00076 } else { 00077 VIB_DISABLE_IRQ(); 00078 irq_port1_deactivate(VIB_IRQ()); 00079 } 00080 return 1; 00081 } 00082 return 0; 00083 } 00084 /*---------------------------------------------------------------------------*/ 00085 static int 00086 status(int type) 00087 { 00088 switch(type) { 00089 case SENSORS_ACTIVE: 00090 case SENSORS_READY: 00091 return VIB_IRQ_ENABLED(); 00092 } 00093 return 0; 00094 } 00095 /*---------------------------------------------------------------------------*/ 00096 SENSORS_SENSOR(vib_sensor, VIB_SENSOR, 00097 value, configure, status);