2016-10-12 07:58:53 +02:00
|
|
|
#include "ksbit.h"
|
|
|
|
|
2016-11-03 06:35:00 +01:00
|
|
|
enum MotorCommand {
|
|
|
|
//% block=coast
|
|
|
|
Coast,
|
|
|
|
//% block=break
|
|
|
|
Break,
|
|
|
|
//% block=sleep
|
|
|
|
Sleep
|
|
|
|
};
|
|
|
|
|
|
|
|
enum Motor {
|
|
|
|
A,
|
|
|
|
B,
|
|
|
|
//% block="A and B"
|
|
|
|
AB
|
|
|
|
};
|
|
|
|
|
2016-10-12 07:58:53 +02:00
|
|
|
/**
|
|
|
|
* Blocks to control the onboard motors
|
|
|
|
*/
|
2016-10-28 01:15:44 +02:00
|
|
|
//% color=#008272 weight=30
|
2016-10-12 07:58:53 +02:00
|
|
|
namespace motors {
|
|
|
|
/**
|
2016-11-03 06:35:00 +01:00
|
|
|
* Turns on the motor at a certain percent of power.
|
2016-10-12 07:58:53 +02:00
|
|
|
* @param power %percent of power sent to the motor. Negative power goes backward. eg: 50
|
|
|
|
*/
|
2016-11-03 06:35:00 +01:00
|
|
|
//% blockId=motor_on block="motor on at %percent"
|
|
|
|
//% parts=dcmotor weight=90 blockGap=8
|
|
|
|
void motorPower(int power) {
|
2016-10-12 07:58:53 +02:00
|
|
|
uBit.soundmotor.Motor_On(power);
|
|
|
|
}
|
2016-11-03 06:35:00 +01:00
|
|
|
|
|
|
|
/**
|
|
|
|
* Send break, coast or sleep commands to the motor
|
|
|
|
*/
|
|
|
|
//% blockId=motor_command block="motor %command"
|
|
|
|
//% parts=dcmotor weight=85
|
|
|
|
void motorCommand(MotorCommand command) {
|
|
|
|
switch(command) {
|
|
|
|
case MotorCommand::Coast: uBit.soundmotor.Motor_Coast();break;
|
|
|
|
case MotorCommand::Break: uBit.soundmotor.Motor_Break();break;
|
|
|
|
case MotorCommand::Sleep: uBit.soundmotor.Motor_Sleep();break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Controls two motors attached to the board.
|
|
|
|
*/
|
|
|
|
//% blockId=block_dual_motor block="motor %motor|at %percent"
|
|
|
|
//% weight=80
|
|
|
|
void dualMotorPower(Motor motor, int duty_percent) {
|
|
|
|
switch(motor) {
|
2016-11-09 11:56:14 +01:00
|
|
|
case Motor::A: if (duty_percent <= 0) uBit.soundmotor.MotorA_Off();
|
2016-11-03 06:35:00 +01:00
|
|
|
else uBit.soundmotor.MotorA_On(duty_percent); break;
|
2016-11-09 11:56:14 +01:00
|
|
|
case Motor::B: if (duty_percent <= 0) uBit.soundmotor.MotorB_Off();
|
2016-11-03 06:35:00 +01:00
|
|
|
else uBit.soundmotor.MotorB_On(duty_percent); break;
|
|
|
|
case Motor::AB: if (duty_percent <= 0) {
|
|
|
|
uBit.soundmotor.MotorA_Off();
|
|
|
|
uBit.soundmotor.MotorB_Off();
|
|
|
|
} else {
|
2016-11-09 11:56:14 +01:00
|
|
|
uBit.soundmotor.MotorA_On(duty_percent);
|
|
|
|
uBit.soundmotor.MotorB_On(duty_percent);
|
|
|
|
}
|
2016-11-03 06:35:00 +01:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2016-10-12 07:58:53 +02:00
|
|
|
}
|