drawProjectedLine.ino

void drawProjectedLine(point3D_type from, point3D_type to) {
  from.z += CAM_F;
  to.z += CAM_F;

  int x1_2D = CAM_X + (int)(((double)from.x / (double)from.z) * CAM_F);
  int y1_2D = CAM_Y + (int)(((double)from.y / (double)from.z) * CAM_F);

  int x2_2D = CAM_X + (int)(((double)to.x / (double)to.z) * CAM_F);
  int y2_2D = CAM_Y + (int)(((double)to.y / (double)to.z) * CAM_F);

  /* take projected positions and draw on screen */
  display.drawLine(x1_2D, y1_2D, x2_2D, y2_2D, WHITE);
}