altoslib: fix computation of TeleGPS battery voltage
[fw/altos] / src / cc1111 / ao_beep.c
1 /*
2  * Copyright © 2009 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License along
15  * with this program; if not, write to the Free Software Foundation, Inc.,
16  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18
19 #include "ao.h"
20
21 void
22 ao_beep(uint8_t beep)
23 {
24         if (beep == 0) {
25                 P2_0 = 0;
26                 P2SEL = (P2SEL & ~P2SEL_SELP2_0_MASK) | P2SEL_SELP2_0_GPIO;
27                 T4CTL = 0;
28         } else {
29                 P2SEL = (P2SEL & ~P2SEL_SELP2_0_MASK) | P2SEL_SELP2_0_PERIPHERAL;
30                 T4CC0 = beep;
31                 T4CTL = TxCTL_DIV_32 | TxCTL_MODE_MODULO | TxCTL_START;
32         }
33 }
34
35 void
36 ao_beep_for(uint8_t beep, uint16_t ticks) __reentrant
37 {
38         ao_beep(beep);
39         ao_delay(ticks);
40         ao_beep(0);
41 }
42
43 void
44 ao_beep_init(void)
45 {
46         /* Our beeper is on P2_0, which is hooked to timer 4 using
47          * configuration alternative 2
48          */
49         P2_0 = 0;
50         P2SEL = (P2SEL & ~P2SEL_SELP2_0_MASK) | P2SEL_SELP2_0_GPIO;
51         PERCFG = (PERCFG & ~PERCFG_T4CFG_ALT_MASK) | PERCFG_T4CFG_ALT_2;
52         T4CCTL0 = TxCCTLy_CMP_TOGGLE|TxCCTLy_CMP_MODE_ENABLE;
53 }