CEB 3D Printer

From Open Source Ecology
Jump to: navigation, search

Concept (Illustrated Below): This idea is to develop an automated brick-laying system that can build homes from the ground up, literally. Using a combination of the CEB Press, a conveyor belt, gripper, and a common machine configuration (TBD), the machine acts like a large 3D printer which picks and places compressed bricks robotically.

Also see Automated_construction


Concept Diagram

CEB 3DP Architecture.png

Two video animations, originally made as Java applets, illustrate two such designs:


Animation (Gantry & Cable Designs)

0.jpg 0.jpg


High-Level Actuator & Feedback Architecture:

CEB3DPrinterActuatorArchitecture.png CEB3DP FeedbackArchitecture.png


Logic Flowchart:

CEB3DP LogicFlowChart.png


Sample Source Code: page`1

Pseudo Code
Arduino Code
DECLARE VARIABLES & FUNCTIONS

Initialize Output Channels
// Tell microcontroller which pins are output
Initialize Input Channels
 // Tell microcontroller which pins are input

MAIN LOOP

  For Motors 1 to 4:
      Read Encoder Values
      Calculate Motor Output to Achieve Desired Position
      Write to Motor Output Channel
      // Note: the motor signal is sent to a speed controller
     // to be amplified
  END FOR LOOP
 
END MAIN LOOP
void setup()
{
  pinMode(2, OUTPUT); // to Base motor 1
  pinMode(3, OUTPUT); // to Base motor 2
  pinMode(4, OUTPUT); // to Base motor 3
  pinMode(5, OUTPUT); // to Base motor 4

  pinMode(6, INPUT); // from digital Encoder 1
  pinMode(7, INPUT); // from digital Encoder 2
  pinMode(8, INPUT); // from digital Encoder 3
  pinMode(9, INPUT); // from digital Encoder 4
}

void loop()
{
  for (int motorIndex = 0; motorIndex < 3; motorIndex++)
  {
    read_encoders();
   
    pid();

    write_to_motors();
  } 
}


FUNCTION NAME:
INPUT TO FUNCTIONS
OUTPUT OF FUNCTIONS
*: unfinished or incorrect function, will change within a week.


Read Encoders Function: Read digital encoders and scale the value accordingly to return current length in feet. This function will need to be written after testing is done, but I can provide skeleton code soon.*

 
Code coming when encoder selection is finalized.
 




pageEncoders

How do you get “cable length” from encoders?

Encoders gives feedback on incremental position and direction only, from which you can use to find velocity, acceleration, total distance travelled, etc.  However, you don’t have a reference point for starting out: meaning that as soon as the software is powered on, and the actuators start moving you may have travelled 0.5234’.  But from where?

Home position sensors are used by triggering a sensor/switch at a pre-determined location so that after the sensor is tripped, the length is set to originate from that pre-determined length. So for example, if you know the switch/sensor is triggered when the gripper is 5.1234' away from the top pulley - along the length of the cable - then reset the encoder count and the new length will be 5.1234' +/- the sensor count (converted to ft.)  

This can be as simple as releasing all 3 motors, and pulling on one until the gripper is 1 foot length from, the top pulley – a location where it will never be in normal operationally.  An attachment connected that flips a switch.  Once flipped, measure the actual physical location and this becomes a constant in software.



An Example:

Let’s say that this encoder (from omron.com ) with a 40mm external shaft diameter and a resolution of 300 pulses/rotation is used.

CEB3DP OmronEncoderExample.png

The Home position sensor routine runs for each motor. 

Let’s say the encoders are mounted so that there they spin from the friction on the cable, without-slipping.  If the cable moves in the releasing direction one foot in length, the encoder spins this direction:




The example in Code:

// 1 millimeter = 0.0032808399 feet

mm2ft = 0.0032808399;   // conversion variable
counts_per_rev = 300;

diameter = 40;          // mm
diameter = 40*mm2ft;    // convert shaft to ft.

circumference = diameter*pi;

distance_per_rev = circumference

//******************************************************//
// Example: distance = 1 ft. how many counts are recorded?

distance = 1;
counts = (counts_per_rev)*(1/distance_per_rev)*distance

// counts =
// 
//        727.66

// rounded down to 727 as counts are integers

// Example: counts = 1000. How much distance travelled?

counts = 1000;
distance = (distance_per_rev)*(1/counts_per_rev)*counts

// distance =
// 
//        1.3743 (feet)


//******************************************************//



Calculate Length Function: Now that desired gripper position & all 4 current lengths are known, desired length for each cable can be calculated.*(current length is already known actually from previous function, will update code soon)


float px, py, pz; // p (x,y,z) is the current position of the gripper
float dpx, dpy, dpz; // p (x,y,z) is the desired position of the gripper

float Bheight = 12.0, Blength = 18.0, Bwidth = 12.0; // Base dimensions at 12'x18'x12'

float B1x = 0.0,     B1y = 0.0,       B1z = Bheight; // top point of base rod 1
float B2x = 0.0,     B2y = Blength,   B2z = Bheight; // top point of base rod 2
float B3x = Bwidth,  B3y = Blength,   B3z = Bheight; // top point of base rod 3
float B4x = Bwidth,  B4y = Blength,   B4z = Bheight; // top point of base rod 4

float L1,L2,L3,L4, dL1,dL2,dL3,dL4; // Current and desired length variables

// This function calculates the length that each of the cables
// must be in order to attain the desired gripper position.
void get_lengths() 
{
  
  // Lengths are determined from top of base rod to gripper,
  // so this does not include length from motor to pulley 
  // at the top of the rod.
  
  L1 = dist3d(B1x, B1y, B1z, px,py,pz);  // Length of cable 1 in feet
  L2 = dist3d(B2x, B2y, B2z, px,py,pz);  // Length of cable 2 in feet
  L3 = dist3d(B3x, B3y, B3z, px,py,pz);  // Length of cable 3 in feet
  L4 = dist3d(B4x, B4y, B4z, px,py,pz);  // Length of cable 4 in feet
  
  // Desired lengths calculated the same way.
  
  dL1 = dist3d(B1x, B1y, B1z, dpx,dpy,dpz); // Desired length of cable 1
  dL2 = dist3d(B2x, B2y, B2z, dpx,dpy,dpz); // Desired length of cable 2
  dL3 = dist3d(B3x, B3y, B3z, dpx,dpy,dpz); // Desired length of cable 3
  dL4 = dist3d(B4x, B4y, B4z, dpx,dpy,dpz); // Desired length of cable 4
  
}

//____________CALCULATE_THE_3-D_DISTANCE_(L-3_NORM)________________//
float dist3d(float p1x, float p1y, float p1z, float p2x, float p2y, float p2z)
{
  float dist3 = sqrt((p2x-p1x)*(p2x-p1x) + (p2y-p1y)*(p2y-p1y) + (p2z-p1z)*(p2z-p1z));
  return dist3;
}


PID Function: Now that desired length and current length are known, motor output and direction for each motor can be calculated.

float[] err = new float[4];  // error array
float[] dir = new float[4];  // direction array
float[] out = new float[4];  // output array

float kp = 500;  // this gain is arbitrary, but must be positive
float Prop;      // Variable used for proportional gain.
float max_output = 100; // Saturate the output at 100, also arbitrary

//___________________PID_FUNCTION______________________//
void pid() // Actually just P for simplicity's sake
{
  
  Prop = kp*err[motorIndex]; // P = const*(desired_length - current_length)
  out[motorIndex] = Prop;    // output = P;
 
  if (out[motorIndex] > 0)  dir[motorIndex] = 1; // Get direction either 1
  else dir[motorIndex] = 0;                      // or 0
  
  constrain(out[motorIndex], -max_output, max_output); // saturate output
  out[motorIndex] = abs(out[motorIndex]); // now that we know direction, we
                                          // just need the absolute output
}


Write to Motors Function: Digital write to speed controllers (output is amplified using the higher current & voltage power source from 12V batteries. This function, just like the encoders will need to be written after/while testing is done, but I can provide skeleton code soon. *

 
PWM code coming soon.
 






page2 Strategy to Design and Build:

PHASE 1: Proof-of-Concept (5-10 people)

1. Gripper Design
    a.) Research what's available for this application in terms of ballpark specs and power requirements, decide if feedback is necessary
    b.) Actuator Selection: motors/servos
    c.) Produce CAD of all mechanical parts

2. Mechanical Design (ideally 2 people should be on this)
    a.) Research materials
    b.) Produce CAD models and assembly
    c.) Perform FEA and verify deflection assumptions based on realist forces and prescribed displacement:  i.e., if using Aluminum and part is being stretched laterally, how much does it deflect?  If greater than 1 cm, redesign, consider alternative material, or simply account for this in software.
    d.) Bill of materials

3. Communication to gripper
    a.) Wireless would be nice: http://www.sparkfun.com/tutorials/128, research and justify selection of technology to go with.
    b.) Test at least one solution once purchased for range and loss of communication.
    c.) Find what data needs to be sent and how often (actually this is probably easy, could be as simple as grip/ungrip 10 Hz - not bad)

Goal: be able to manually input single position coordinates, e.g. (x,y,z)=(4.213',5.9234',1.512') and measure how accurate and consistent system is, i.e. is it biased to one side at a higher level? Can mechanical shortcomings be remedied in software.
   

PHASE 2: Scaling up and adding complexity

4. Data input - Using XML or .txt file, pass in from PC to microcontroller via serial connection a list of coordinates.
    a.) Write program to design a structure & output XML file - the one complication here is to post-process the solid and write sub-routines to convert solid into something to be completely built from bricks.
        i.) Tutorial on how to do so
        ii.) Generate at least 2 sample files.
    b.) Write program to read XML file and send to microcontroller
    c.) Arduino sub-routine to read in data.

5. A simple control board for translational speed, display number of brick, start, stop, etc.

6. Base Mobile Platform - http://www.robotcombat.com/store_tanktreads.html either tank treads or wheels
    a.) Research
    b.) CAD
    c.) Integration with current software