BV I2C: add action command
This commit is contained in:
parent
b8304d588f
commit
87d68d5b48
|
@ -151,8 +151,270 @@ static void busvoodoo_i2c_exit(void)
|
|||
busvoodoo_embedded_pullup(false); // disable embedded pull-ups
|
||||
}
|
||||
|
||||
/** read from I2C */
|
||||
static void busvoodoo_i2c_read(void)
|
||||
{
|
||||
printf("read: ");
|
||||
uint8_t data; // to store the data read
|
||||
switch (i2c_master_read(BUSVOODOO_I2C, &data, 1)) {
|
||||
case I2C_MASTER_RC_NONE: // all went fine
|
||||
printf("0x%02x", data); // show data
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_MASTER:
|
||||
printf("slave not selected");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_READY:
|
||||
printf("slave not ready");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_RECEIVE:
|
||||
printf("not in receive mode");
|
||||
break;
|
||||
default:
|
||||
printf("error");
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
/** write to I2C
|
||||
* @param[in] data data to write
|
||||
*/
|
||||
static void busvoodoo_i2c_write(uint8_t data)
|
||||
{
|
||||
printf("write 0x%02x: ", data);
|
||||
switch (i2c_master_write(BUSVOODOO_I2C, &data, 1)) {
|
||||
case I2C_MASTER_RC_NONE: // all went fine
|
||||
printf("ack");
|
||||
break;
|
||||
case I2C_MASTER_RC_NAK:
|
||||
printf("nack");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_MASTER:
|
||||
printf("slave not selected");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_READY:
|
||||
printf("slave not ready");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_TRANSMIT:
|
||||
printf("not in transmit mode");
|
||||
break;
|
||||
default:
|
||||
printf("error");
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
/** select I2C slave
|
||||
* @param[in] slave slave I2C address
|
||||
* @param[in] write enter read (false) or write (true) mode
|
||||
*/
|
||||
static void busvoodoo_i2c_select(uint16_t slave, bool write)
|
||||
{
|
||||
printf("select slave ");
|
||||
if (10==busvoodoo_i2c_addressbits) {
|
||||
printf("0x%03x", slave);
|
||||
} else {
|
||||
printf("0x%02x", slave);
|
||||
}
|
||||
printf(" to %s: ", write ? "write" : "read");
|
||||
switch (i2c_master_select_slave(BUSVOODOO_I2C, slave, 10==busvoodoo_i2c_addressbits, write)) {
|
||||
case I2C_MASTER_RC_NONE: // all went fine
|
||||
printf("selected");
|
||||
break;
|
||||
case I2C_MASTER_RC_NAK:
|
||||
printf("no such slave");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_MASTER:
|
||||
printf("can't become master");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_RECEIVE:
|
||||
printf("not in receive mode");
|
||||
break;
|
||||
case I2C_MASTER_RC_NOT_TRANSMIT:
|
||||
printf("not in transmit mode");
|
||||
break;
|
||||
default:
|
||||
printf("error");
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
/** perform I2C action
|
||||
* @param[in] action action to perform
|
||||
* @param[in] repetition how many times to perform the action
|
||||
* @param[in] perform the action (true) or just check it (false)
|
||||
* @return true if the action has been performed, false if it is malformed
|
||||
*/
|
||||
static bool busvoodoo_i2c_action(const char* action, uint32_t repetition, bool perform)
|
||||
{
|
||||
uint32_t length = strlen(action); // remember length since it will be used a number of times
|
||||
if (NULL==action || 0==length) { // there is nothing to do
|
||||
return true;
|
||||
}
|
||||
|
||||
if (1==length && 'r'==action[0]) { // read data
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
busvoodoo_i2c_read(); // read from I2C
|
||||
}
|
||||
} else if (1==length && '['==action[0]) { // select slave
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
printf("send start condition: ");
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
printf("%s ", I2C_MASTER_RC_NONE==i2c_master_start(BUSVOODOO_I2C) ? "sent" : "error");
|
||||
}
|
||||
printf("\n");
|
||||
} else if (1==length && ']'==action[0]) { // deselect slave
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
printf("send stop condition: ");
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
printf("%s ", I2C_MASTER_RC_NONE==i2c_master_stop(BUSVOODOO_I2C) ? "sent" : "error");
|
||||
}
|
||||
printf("\n");
|
||||
} else if (1==length && 'u'==action[0]) { // sleep us
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
printf("wait for %u us\n", repetition);
|
||||
sleep_us(repetition); // sleep
|
||||
} else if (1==length && 'm'==action[0]) { // sleep ms
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
printf("wait for %u ms\n", repetition);
|
||||
sleep_ms(repetition); // sleep
|
||||
} else if ('0'==action[0]) { // send digit
|
||||
if (1==length) { // just send 0
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
busvoodoo_i2c_write(0); // write to I2C
|
||||
}
|
||||
} else if ('x'==action[1] || 'b'==action[1]) { // send hex/binary
|
||||
return busvoodoo_i2c_action(action+1, repetition, perform); // just retry without leading 0
|
||||
} else if (action[1]>='0' && action[1]<='9') { // send decimal
|
||||
return busvoodoo_i2c_action(action+1, repetition, perform); // just retry without leading 0
|
||||
} else if ('r'==action[1] && 2==length) { // select slave to read
|
||||
busvoodoo_i2c_select(0, false); // select slave 0 to read
|
||||
} else if ('w'==action[1] && 2==length) { // select slave to write
|
||||
busvoodoo_i2c_select(0, true); // select slave 0 to write
|
||||
} else { // malformed action
|
||||
return false;
|
||||
}
|
||||
} else if ('x'==action[0] && length>1) { // send hexadecimal value
|
||||
for (uint32_t i=1; i<length; i++) { // check string
|
||||
if (!((action[i]>='0' && action[i]<='9') || (action[i]>='a' && action[i]<='f') || (action[i]>='A' && action[i]<='F') || ('r'==action[i] && i==length-1) || ('w'==action[i] && i==length-1))) { // check for hexadecimal character or r/w flag
|
||||
return false; // not an hexadecimal string
|
||||
}
|
||||
}
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
uint32_t value = strtol(&action[1], NULL, 16); // get hex value
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
if ('r'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, false); // select slave to read
|
||||
} else if ('w'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, true); // select slave to write
|
||||
} else {
|
||||
busvoodoo_i2c_write(value); // write to I2C
|
||||
}
|
||||
}
|
||||
} else if ('b'==action[0] && length>1) { // send binary value
|
||||
for (uint32_t i=1; i<length; i++) { // check string
|
||||
if (!('0'==action[i] || '1'==action[i] || ('r'==action[i] && i==length-1) || ('w'==action[i] && i==length-1))) { // check for binary character or r/w flag
|
||||
return false; // not a binary string
|
||||
}
|
||||
}
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
uint32_t value = strtol(&action[1], NULL, 2); // get binary value
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
if ('r'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, false); // select slave to read
|
||||
} else if ('w'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, true); // select slave to write
|
||||
} else {
|
||||
busvoodoo_i2c_write(value); // write to I2C
|
||||
}
|
||||
}
|
||||
} else if (action[0]>='1' && action[0]<='9') { // send decimal value
|
||||
for (uint32_t i=1; i<length; i++) { // check string
|
||||
if (!((action[i]>='0' && action[i]<='9') || ('w'==action[i] && i==length-1))) { // check for decimal character or r/w flag
|
||||
return false; // not a decimal string
|
||||
}
|
||||
}
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
uint32_t value = strtol(&action[0], NULL, 10); // get decimal value
|
||||
for (uint32_t i=0; i<repetition; i++) {
|
||||
if ('r'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, false); // select slave to read
|
||||
} else if ('w'==action[length-1]) {
|
||||
busvoodoo_i2c_select(value, true); // select slave to write
|
||||
} else {
|
||||
busvoodoo_i2c_write(value); // write to I2C
|
||||
}
|
||||
}
|
||||
} else if (length>=2 && ('"'==action[0] || '\''==action[0]) && (action[length-1]==action[0])) { // send ASCII character
|
||||
if (!perform) {
|
||||
return true;
|
||||
}
|
||||
for (uint32_t r=0; r<repetition; r++) {
|
||||
for (uint32_t i=1; i<length-1; i++) { // go through string
|
||||
busvoodoo_i2c_write(action[i]); // write to I2C
|
||||
}
|
||||
}
|
||||
} else { // malformed action
|
||||
return false;
|
||||
}
|
||||
return true; // all went well
|
||||
}
|
||||
|
||||
// command handlers
|
||||
|
||||
/** command to perform actions
|
||||
* @param[in] argument actions to perform
|
||||
*/
|
||||
static void busvoodoo_i2c_command_actions(void* argument)
|
||||
{
|
||||
if (NULL==argument || 0==strlen(argument)) {
|
||||
printf("available actions (separated by space or ,):\n");
|
||||
printf("[/]\tsend start/stop conditions\n");
|
||||
printf("0x0r\tselect slave with I2C address to read\n");
|
||||
printf("0x0w\tselect slave with I2C address to write\n");
|
||||
printf("0\twrite decimal value\n");
|
||||
printf("0x0\twrite hexadecimal value\n");
|
||||
printf("0b0\twrite binary value\n");
|
||||
printf("\"a\"/'a'\twrite ASCII characters\n");
|
||||
printf("r\tread value\n");
|
||||
printf("u/m\twait 1 us/ms\n");
|
||||
printf(":n\trepeat action n times\n");
|
||||
return;
|
||||
}
|
||||
// copy argument since it will be modified
|
||||
char* copy = calloc(strlen(argument)+1, sizeof(char));
|
||||
if (!copy) {
|
||||
while (true);
|
||||
}
|
||||
strncpy(copy, argument, strlen(argument)+1);
|
||||
// verify and perform actions
|
||||
if (!busvoodoo_global_actions(copy, false, &busvoodoo_i2c_action)) { // verify actions
|
||||
printf("malformed action(s)\n");
|
||||
} else { // action are ok
|
||||
busvoodoo_global_actions(argument, true, &busvoodoo_i2c_action); // perform action
|
||||
}
|
||||
free(copy); // release memory
|
||||
}
|
||||
|
||||
/** command to scan for slave devices
|
||||
* @param[in] argument no argument required
|
||||
*/
|
||||
|
@ -173,26 +435,47 @@ static void busvoodoo_i2c_command_scan(void* argument)
|
|||
int16_t i2c_slaves = 0; // number of slaves found
|
||||
// check for I2C slaves by going through the address space
|
||||
for (uint16_t address=0; address < (1<<busvoodoo_i2c_addressbits); address++) {
|
||||
if (!i2c_master_start(BUSVOODOO_I2C)) { // send start condition
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
printf("start condition failed\n"); // show error to user
|
||||
busvoodoo_led_blue(100); // pulse blue LED to show transmission
|
||||
switch (i2c_master_select_slave(BUSVOODOO_I2C, address, 10==busvoodoo_i2c_addressbits, false)) { // try to select slave (includes start condition)
|
||||
case I2C_MASTER_RC_NONE: // slave found
|
||||
busvoodoo_led_red(100); // pulse red LED to show we found a slave
|
||||
printf((busvoodoo_i2c_addressbits>7) ? "0x%03x " : "0x%02x ", address); // display address
|
||||
i2c_slaves++; // increase slave count
|
||||
break;
|
||||
case I2C_MASTER_RC_START_STOP_IN_PROGESS: // I2C peripheral error
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
printf("start condition failed\n"); // show error to user
|
||||
led_blink(0.5, 0.5); // show error on LEDs
|
||||
i2c_slaves = -2; // remember error
|
||||
break; // stop scanning
|
||||
case I2C_MASTER_RC_NOT_MASTER: // start condition failed
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
printf("start condition failed\n"); // show error to user
|
||||
led_blink(0.5, 0.5); // show error on LEDs
|
||||
i2c_slaves = -1; // remember error
|
||||
break; // stop scanning
|
||||
case I2C_MASTER_RC_NAK: // slave did not respond
|
||||
break; // nothing to do
|
||||
default: // unexpected error
|
||||
i2c_slaves = -1; // remember error
|
||||
break;
|
||||
}
|
||||
if (i2c_slaves<0) { // error happend
|
||||
led_blink(0.5, 0.5); // show error on LEDs
|
||||
i2c_slaves = -1; // remember error
|
||||
break; // stop scanning
|
||||
if (-1==i2c_slaves) { // just end communication
|
||||
i2c_master_stop(BUSVOODOO_I2C); // send stop condition
|
||||
} else if (-2==i2c_slaves) { // reset peripheral
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
}
|
||||
break; // stop scan
|
||||
} else {
|
||||
busvoodoo_led_blue(100); // pulse blue LED to show transmission
|
||||
}
|
||||
if (i2c_master_select_slave(BUSVOODOO_I2C, address, 10==busvoodoo_i2c_addressbits, true)) { // try to select slave
|
||||
busvoodoo_led_red(100); // pulse red LED to show we found a slave
|
||||
printf((busvoodoo_i2c_addressbits>7) ? "0x%03x " : "0x%02x ", address); // display address
|
||||
i2c_slaves++; // increase slave count
|
||||
}
|
||||
if (!i2c_master_stop(BUSVOODOO_I2C)) { // send stop condition
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
printf("start condition failed\n"); // show error to user
|
||||
led_blink(0.5, 0.5); // show error on LEDs
|
||||
i2c_slaves = -1; // remember error
|
||||
break;
|
||||
if (I2C_MASTER_RC_NONE!=i2c_master_stop(BUSVOODOO_I2C)) { // stop stop condition
|
||||
i2c_master_reset(BUSVOODOO_I2C); // reset the I2C peripheral since it might be stuck
|
||||
printf("stop condition failed\n"); // show error to user
|
||||
led_blink(0.5, 0.5); // show error on LEDs
|
||||
i2c_slaves = -1; // remember error
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (i2c_slaves>0) {
|
||||
|
@ -204,6 +487,14 @@ static void busvoodoo_i2c_command_scan(void* argument)
|
|||
}
|
||||
|
||||
static const struct menu_command_t busvoodoo_i2c_commands[] = {
|
||||
{
|
||||
'a',
|
||||
"action",
|
||||
"perform protocol actions",
|
||||
MENU_ARGUMENT_STRING,
|
||||
"[actions]",
|
||||
&busvoodoo_i2c_command_actions,
|
||||
},
|
||||
{
|
||||
's',
|
||||
"scan",
|
||||
|
|
Loading…
Reference in New Issue