Add functions to demo to control amp

This commit is contained in:
Aadi Desai 2023-06-24 20:53:40 +01:00
parent 44215ffdf0
commit 10920aa065
No known key found for this signature in database

View file

@ -8,8 +8,10 @@
#include <generated/csr.h> #include <generated/csr.h>
#include <irq.h> #include <irq.h>
#include <libbase/console.h> #include <libbase/console.h>
#include <libbase/i2c.h>
#include <libbase/uart.h> #include <libbase/uart.h>
#include "amp"
#include "audio" #include "audio"
#include "can" #include "can"
@ -107,6 +109,10 @@ static void help(void) {
#ifdef CSR_DAC_VOL_BASE #ifdef CSR_DAC_VOL_BASE
puts("volume - Get / Set DAC Volume"); puts("volume - Get / Set DAC Volume");
#endif #endif
#ifdef CONFIG_HAS_I2C
puts("amp - Get / Set AMP Settings");
puts("vol - Get / Set AMP Volume");
#endif
#ifdef CSR_CAN_BASE #ifdef CSR_CAN_BASE
puts("can_id - Get / Set CAN ID"); puts("can_id - Get / Set CAN ID");
puts("can_mask - Get / Set CAN Mask"); puts("can_mask - Get / Set CAN Mask");
@ -239,6 +245,45 @@ static void dac_vol_cmd(char **val) {
} }
} }
#endif #endif
#ifdef CONFIG_HAS_I2C
static void amp_cmd(char **val) {
char *token = get_token(val);
if (token == *val) {
amp_i2c temp;
if (!amp_read(temp)) {
printf("Failed to read AMP state\n");
return;
}
printf("AMP State: 0x%02X, 0x%02X, 0x%02X\n", temp.pot0, temp.pot1, temp.conf);
} else {
uint8_t pot0 = (uint8_t)strtol(token, NULL, 0);
uint8_t pot1 = (uint8_t)strtol(get_token(val), NULL, 0);
uint8_t conf = (uint8_t)strtol(get_token(val), NULL, 0);
printf("Setting AMP State to: 0x%02X, 0x%02X, 0x%02X\n", pot0, pot1, conf);
if (!amp_write({pot0, pot1, conf})) {
printf("Failed to write AMP state\n");
}
}
}
static void amp_vol_cmd(char **val) {
char *token = get_token(val);
amp_i2c temp;
if (!amp_read(temp)) {
printf("Failed to read AMP state\n");
return;
}
if (token == *val) {
printf("AMP volume is %d (of 63)\n", temp.pot0);
} else {
uint8_t vol = (uint8_t)strtol(token, NULL, 0);
printf("Setting AMP volume to %d (of 63)\n", vol);
if (!amp_write({vol, vol, temp.conf})) {
printf("Failed to write AMP state\n");
}
}
}
#endif
#ifdef CSR_CAN_BASE #ifdef CSR_CAN_BASE
static void can_id_cmd(char **val) { static void can_id_cmd(char **val) {
@ -429,6 +474,12 @@ static void console_service(void) {
else if (strcmp(token, "volume") == 0) else if (strcmp(token, "volume") == 0)
dac_vol_cmd(&str); dac_vol_cmd(&str);
#endif #endif
#ifdef CONFIG_HAS_I2C
else if (strcmp(token, "amp") == 0)
amp_cmd(&str);
else if (strcmp(token, "vol") == 0)
amp_vol_cmd(&str);
#endif
#ifdef CSR_CAN_BASE #ifdef CSR_CAN_BASE
else if (strcmp(token, "can_id") == 0) else if (strcmp(token, "can_id") == 0)
can_id_cmd(&str); can_id_cmd(&str);