public void updateMotors(AngleSet angles)
{
motorManager.setMotorDegrees(MotorManager.RIGHT_SHOULDER_MOTOR1, (angles.rightShoulder1 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.RIGHT_SHOULDER_MOTOR2, (angles.rightShoulder2 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.RIGHT_ELBOW_MOTOR1, (angles.rightElbow1 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.RIGHT_ELBOW_MOTOR2, (angles.rightElbow2 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.LEFT_SHOULDER_MOTOR1, (angles.leftShoulder1 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.LEFT_SHOULDER_MOTOR2, (angles.leftShoulder2 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.LEFT_ELBOW_MOTOR1, (angles.leftElbow1 / 360) * 255);
motorManager.setMotorDegrees(MotorManager.LEFT_ELBOW_MOTOR2, (angles.leftElbow2 / 360) * 255);
}
public AngleCalculator(Skeleton skeleton)
{
// initialises the skeleton and the angles
updateSkeleton(skeleton);
angles = new AngleSet();
}
