static void cmd_fullscale(BaseSequentialStream *chp, int argc, char *argv[]) { (void)argv; if (argc != 1) { chprintf(chp, "Usage: fullscale [2G|4G|6G|8G|16G]\r\n"); return; } #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif if(!strcmp (argv[0], "2G")) { accelerometerSetFullScale(&LIS3DSHD1, LIS3DSH_FS_2G); chprintf(chp, "LIS3DSH Accelerometer full scale set to 2G...\r\n"); } else if(!strcmp (argv[0], "4G")) { accelerometerSetFullScale(&LIS3DSHD1, LIS3DSH_FS_4G); chprintf(chp, "LIS3DSH Accelerometer full scale set to 4G...\r\n"); } else if(!strcmp (argv[0], "6G")) { accelerometerSetFullScale(&LIS3DSHD1, LIS3DSH_FS_6G); chprintf(chp, "LIS3DSH Accelerometer full scale set to 6G...\r\n"); } else if(!strcmp (argv[0], "8G")) { accelerometerSetFullScale(&LIS3DSHD1, LIS3DSH_FS_8G); chprintf(chp, "LIS3DSH Accelerometer full scale set to 8G...\r\n"); } else if(!strcmp (argv[0], "16G")) { accelerometerSetFullScale(&LIS3DSHD1, LIS3DSH_FS_16G); chprintf(chp, "LIS3DSH Accelerometer full scale set to 16G...\r\n"); } else { chprintf(chp, "Usage: fullscale [2G|4G|6G|8G|16G]\r\n"); return; } }
static void cmd_fullscale(BaseSequentialStream *chp, int argc, char *argv[]) { (void)argv; if (argc < 1) { chprintf(chp, "Usage: fullscale [acc|gyro] [value]\r\n"); return; } if (!strcmp (argv[0], "acc")) { #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif if(!strcmp (argv[1], "2G")) { accelerometerSetFullScale(&LSM6DS0D1, LSM6DS0_ACC_FS_2G); chprintf(chp, "LSM6DS0 Accelerometer full scale set to 2G...\r\n"); } else if(!strcmp (argv[1], "4G")) { accelerometerSetFullScale(&LSM6DS0D1, LSM6DS0_ACC_FS_4G); chprintf(chp, "LSM6DS0 Accelerometer full scale set to 4G...\r\n"); } else if(!strcmp (argv[1], "8G")) { accelerometerSetFullScale(&LSM6DS0D1, LSM6DS0_ACC_FS_8G); chprintf(chp, "LSM6DS0 Accelerometer full scale set to 8G...\r\n"); } else if(!strcmp (argv[1], "16G")) { accelerometerSetFullScale(&LSM6DS0D1, LSM6DS0_ACC_FS_16G); chprintf(chp, "LSM6DS0 Accelerometer full scale set to 16G...\r\n"); } else { chprintf(chp, "Usage: fullscale acc [2G|4G|8G|16G]\r\n"); return; } } else if (!strcmp (argv[0], "gyro")) { #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif if(!strcmp (argv[1], "245")) { gyroscopeSetFullScale(&LSM6DS0D1, LSM6DS0_GYRO_FS_245DPS); chprintf(chp, "LSM6DS0 Gyroscope full scale set to 245 DPS...\r\n"); } else if(!strcmp (argv[1], "500")) { gyroscopeSetFullScale(&LSM6DS0D1, LSM6DS0_GYRO_FS_500DPS); chprintf(chp, "LSM6DS0 Gyroscope full scale set to 500 DPS...\r\n"); } else if(!strcmp (argv[1], "2000")) { gyroscopeSetFullScale(&LSM6DS0D1, LSM6DS0_GYRO_FS_2000DPS); chprintf(chp, "LSM6DS0 Gyroscope full scale set to 2000 DPS...\r\n"); } else { chprintf(chp, "Usage: fullscale gyro [245|500|2000]\r\n"); return; } } else { chprintf(chp, "Usage: fullscale [acc|gyro] [value]\r\n"); return; } }
static void cmd_fullscale(BaseSequentialStream *chp, int argc, char *argv[]) { (void)argv; if (argc < 1) { chprintf(chp, "Usage: fullscale [acc|comp] [value]\r\n"); return; } if (!strcmp (argv[0], "acc")) { #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif if(!strcmp (argv[1], "2G")) { accelerometerSetFullScale(&LSM303DLHCD1, LSM303DLHC_ACC_FS_2G); chprintf(chp, "LSM303DLHC Accelerometer full scale set to 2G...\r\n"); } else if(!strcmp (argv[1], "4G")) { accelerometerSetFullScale(&LSM303DLHCD1, LSM303DLHC_ACC_FS_4G); chprintf(chp, "LSM303DLHC Accelerometer full scale set to 4G...\r\n"); } else if(!strcmp (argv[1], "8G")) { accelerometerSetFullScale(&LSM303DLHCD1, LSM303DLHC_ACC_FS_8G); chprintf(chp, "LSM303DLHC Accelerometer full scale set to 8G...\r\n"); } else if(!strcmp (argv[1], "16G")) { accelerometerSetFullScale(&LSM303DLHCD1, LSM303DLHC_ACC_FS_16G); chprintf(chp, "LSM303DLHC Accelerometer full scale set to 16G...\r\n"); } else { chprintf(chp, "Usage: fullscale acc [2G|4G|8G|16G]\r\n"); return; } } else if (!strcmp (argv[0], "comp")) { #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif if(!strcmp (argv[1], "1.3")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_1P3GA); chprintf(chp, "LSM303DLHC Compass full scale set to 1.3 Gauss...\r\n"); } else if(!strcmp (argv[1], "1.9")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_1P9GA); chprintf(chp, "LSM303DLHC Compass full scale set to 1.9 Gauss...\r\n"); } else if(!strcmp (argv[1], "2.5")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_2P5GA); chprintf(chp, "LSM303DLHC Compass full scale set to 2.5 Gauss...\r\n"); } else if(!strcmp (argv[1], "4.0")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_4P0GA); chprintf(chp, "LSM303DLHC Compass full scale set to 4.0 Gauss...\r\n"); } else if(!strcmp (argv[1], "4.7")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_4P7GA); chprintf(chp, "LSM303DLHC Compass full scale set to 4.7 Gauss...\r\n"); } else if(!strcmp (argv[1], "5.6")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_5P6GA); chprintf(chp, "LSM303DLHC Compass full scale set to 5.6 Gauss...\r\n"); } else if(!strcmp (argv[1], "8.1")) { compassSetFullScale(&LSM303DLHCD1, LSM303DLHC_COMP_FS_8P1GA); chprintf(chp, "LSM303DLHC Compass full scale set to 8.1 Gauss...\r\n"); } else { chprintf(chp, "Usage: fullscale comp [1.3|1.9|2.5|4.0|4.7|5.6|8.1]\r\n"); return; } } else { chprintf(chp, "Usage: fullscale [acc|comp] [value]\r\n"); return; } }