/*
 * Code for exercising Motorola's vibrator, which is driven
 * via the Iota auxiliary DAC on this phone.
 */

#include <sys/types.h>
#include "types.h"
#include "abbdefs.h"

void
cmd_dacon()
{
	abb_reg_write(TOGBR1, 0x20);
}

void
cmd_dac(argbulk)
	char *argbulk;
{
	char *argv[2];
	u32 val;

	if (parse_args(argbulk, 1, 1, argv, 0) < 0)
		return;
	val = strtoul(argv[0], 0, 0);
	if (val > 0x3FF) {
		printf("ERROR: argument out of range\n");
		return;
	}
	abb_reg_write(AUXDAC, val);
}

void
cmd_vibe(argbulk)
	char *argbulk;
{
	char *argv[2];
	u32 val;
	int c;

	if (parse_args(argbulk, 1, 1, argv, 0) < 0)
		return;
	val = strtoul(argv[0], 0, 0);
	if (val > 0x3FF) {
		printf("ERROR: argument out of range\n");
		return;
	}
	abb_reg_write(AUXDAC, val);
	for (;;) {
		c = serial_in_poll();
		if (c >= 0)
			break;
	}
	abb_reg_write(AUXDAC, 0);
}