control for robotic arm that can play chess using a granular gripper

Dependencies:   Encoder mbed HIDScope Servo MODSERIAL

Fork of chessRobot by a steenbeek

debug.cpp

Committer:
annesteenbeek
Date:
2015-10-12
Revision:
57:43f707648f2b
Parent:
56:f730962fbb53
Child:
60:20945383ad1b

File content as of revision 57:43f707648f2b:

#include "mbed.h"
#include "debug.h"
#include "HIDScope.h"
#include "buttons.h"
#include "actuators.h"
#include "config.h"
// all the debugging functions


#ifdef TUNEPID
HIDScope scope(5);

void debugProcess(){
    scope.set(0, Kp);
	scope.set(1, Ki);
	scope.set(2, Kd);
	scope.set(3, motor2SetSpeed);
	scope.set(4, motor2Speed);
    scope.send();
}

#elif
HIDScope scope(4);

void debugProcess(){
    scope.set(0, pidOut);
	scope.set(1, motor2SetSpeed);
	scope.set(2, motor2Speed);
	scope.set(3, motor2PWM);
    scope.send();
}

#endif