blob: 7dbba773ffd242fc5ea536f1982823382c33e567 [file] [log] [blame]
Matthew Qin03c90772014-02-20 19:55:17 +08001/* Copyright (c) 2014, The Linux Foundation. All rights reserved.
2 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are
5 * met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above
9 * copyright notice, this list of conditions and the following
10 * disclaimer in the documentation and/or other materials provided
11 * with the distribution.
12 * * Neither the name of The Linux Foundation, Inc. nor the names of its
13 * contributors may be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
17 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <bits.h>
30#include <debug.h>
31#include <reg.h>
32#include <pm8x41.h>
33#include <pm_vib.h>
34
35#define QPNP_VIB_EN BIT(7)
36
37/* Turn on vibrator */
38void pm_vib_turn_on(void)
39{
40 uint8_t val;
41
42 val = pm8x41_reg_read(QPNP_VIB_VTG_CTL);
43 val &= ~QPNP_VIB_VTG_SET_MASK;
44 val |= (QPNP_VIB_DEFAULT_VTG_LVL & QPNP_VIB_VTG_SET_MASK);
45 pm8x41_reg_write(QPNP_VIB_VTG_CTL, val);
46
47 val = pm8x41_reg_read(QPNP_VIB_EN_CTL);
48 val |= QPNP_VIB_EN;
49 pm8x41_reg_write(QPNP_VIB_EN_CTL, val);
50}
51
52/* Turn off vibrator */
53void pm_vib_turn_off(void)
54{
55 uint8_t val;
56
57 val = pm8x41_reg_read(QPNP_VIB_EN_CTL);
58 val &= ~QPNP_VIB_EN;
59 pm8x41_reg_write(QPNP_VIB_EN_CTL, val);
60}