public void addVerticalDebrisLeaningAgainstAWall(double xRelativeToRobot, double yRelativeToRobot, double debrisYaw, double debrisPitch)
{
Point3D tempPosition = new Point3D(xRelativeToRobot, yRelativeToRobot, debrisLength / 2.0 * Math.cos(debrisPitch));
FramePose3D debrisPose = generateDebrisPose(tempPosition, debrisYaw, debrisPitch, 0.0);
debrisRobots.add(createDebrisRobot(debrisPose));
double supportWidth = 0.1;
double supportLength = 0.2;
double supportHeight = 1.05*debrisLength;
RigidBodyTransform debrisTransform = new RigidBodyTransform();
debrisPose.get(debrisTransform );
TransformTools.appendRotation(debrisTransform, -debrisPitch, Axis.Y);
debrisPose.set(debrisTransform);
debrisPose.setZ(0.0);
PoseReferenceFrame debrisReferenceFrame = new PoseReferenceFrame("debrisReferenceFrame", debrisPose);
FramePose3D supportPose = new FramePose3D(debrisReferenceFrame);
double x = supportWidth / 2.0 + debrisLength/2.0 * Math.sin(debrisPitch);
double y = 0.0;
double z = supportHeight / 2.0;
supportPose.setPosition(x, y, z);
supportPose.changeFrame(constructionWorldFrame);
RigidBodyTransform supportTransform = new RigidBodyTransform();
supportPose.get(supportTransform);
combinedTerrainObject.addRotatableBox(supportTransform, supportWidth, supportLength, supportHeight, YoAppearance.AliceBlue());
}