diff options
| author | erin_yueh <erin_yueh@99fdad57-331a-0410-800a-d7fa5415bdb3> | 2008-02-26 08:57:39 +0000 |
|---|---|---|
| committer | erin_yueh <erin_yueh@99fdad57-331a-0410-800a-d7fa5415bdb3> | 2008-02-26 08:57:39 +0000 |
| commit | 33b13190e1e8925100a7d577ce9ee72344eff987 (patch) | |
| tree | 1a248b3ff2e901ad5165d849264aaad69d068cf8 /src/gsmd | |
| parent | 7d514fad9af90ea6c12e4bcab41176f5dd9de282 (diff) | |
gsmd: add vibrator at cmd (Sudharshan S)
git-svn-id: http://svn.openmoko.org/trunk/src/target/gsm@4115 99fdad57-331a-0410-800a-d7fa5415bdb3
Diffstat (limited to 'src/gsmd')
| -rw-r--r-- | src/gsmd/usock.c | 33 |
1 files changed, 33 insertions, 0 deletions
diff --git a/src/gsmd/usock.c b/src/gsmd/usock.c index 119ed56..c7f8827 100644 --- a/src/gsmd/usock.c +++ b/src/gsmd/usock.c @@ -679,6 +679,32 @@ static int phone_get_battery_cb(struct gsmd_atcmd *cmd, void *ctx, char *resp) cmd -> id, sizeof(gbs), &gbs); } +static int phone_vibrator_enable_cb(struct gsmd_atcmd *cmd, void *ctx, char *resp) +{ + struct gsmd_user *gu = ctx; + int ret = cmd->ret; + + switch(ret) { + case 0: + gsmd_log(GSMD_DEBUG, "Vibrator enabled\n"); + gu->gsmd->dev_state.vibrator = 1; + break; + default: + gsmd_log(GSMD_DEBUG, "AT+CVIB=1 operation failed\n"); + break; + } + + return gsmd_ucmd_submit(gu, GSMD_MSG_PHONE, GSMD_PHONE_VIB_ENABLE, + cmd->id, sizeof(ret), &ret); +} + +static int phone_vibrator_disable_cb(struct gsmd_atcmd *cmd, void *ctx, char *resp) +{ + int ret = cmd->ret; + return gsmd_ucmd_submit(ctx, GSMD_MSG_PHONE, GSMD_PHONE_VIB_DISABLE, + cmd->id, sizeof(ret), &ret); +} + static int usock_rcv_phone(struct gsmd_user *gu, struct gsmd_msg_hdr *gph, int len) { @@ -718,6 +744,13 @@ static int usock_rcv_phone(struct gsmd_user *gu, struct gsmd_msg_hdr *gph, case GSMD_PHONE_GET_BATTERY: cmd = atcmd_fill("AT+CBC", 6+1, &phone_get_battery_cb, gu, 0, NULL); break; + case GSMD_PHONE_VIB_ENABLE: + cmd = atcmd_fill("AT+CVIB=1", 9+1, &phone_vibrator_enable_cb, gu, 0, NULL); + break; + case GSMD_PHONE_VIB_DISABLE: + cmd = atcmd_fill("AT+CVIB=0", 9+1, &phone_vibrator_disable_cb, gu, 0, NULL); + gu->gsmd->dev_state.vibrator = 0; + break; default: return -EINVAL; } |