CEB 3D Printer: Difference between revisions
mNo edit summary |
mNo edit summary |
||
Line 4: | Line 4: | ||
<div style="text-align: center;"> | <div style="text-align: center;"> | ||
[[Image:CEB_3DP_Architecture.png]] | <u>'''Concept Diagram'''</u> <p></p> | ||
[[Image:CEB_3DP_Architecture.png ]] | |||
</div> | </div> | ||
Two video animations, originally made as Java applets, illustrate two such designs: | Two video animations, originally made as Java applets, illustrate two such designs: | ||
<div style="text-align: center;"> | |||
<div style="text-align: center;"> | <u>'''Animation (Gantry & Cable Designs)'''</u> <p></p> | ||
{{YoutubePopup|Il1stSJcZTU|big}} | {{YoutubePopup|Il1stSJcZTU|big}} | ||
{{YoutubePopup|0HDd9J_Cc14|big}} | {{YoutubePopup|0HDd9J_Cc14|big}} | ||
</div> | </div> | ||
<div style="text-align: center;"> | <div style="text-align: center;"> | ||
<u>'''High-Level Actuator & Feedback Architecture:'''</u><p></p> | |||
[[Image:CEB3DPrinterActuatorArchitecture.png]] | [[Image:CEB3DPrinterActuatorArchitecture.png]] | ||
[[Image:CEB3DP_FeedbackArchitecture.png ]] | |||
[[Image:CEB3DP_FeedbackArchitecture.png]] | |||
</div> | </div> | ||
Line 45: | Line 29: | ||
<div style="text-align: center;"> | <div style="text-align: center;"> | ||
[[Image: | [[Image:CEB3DP LogicFlowChart.png]] | ||
</div> | </div> | ||
Line 170: | Line 154: | ||
<pre> | <pre> | ||
| | ||
Code coming when encoder selection is finalized. | |||
| | ||
</pre> | </pre> | ||
---- | |||
<html> | <html> | ||
<head> | <head> | ||
Line 182: | Line 168: | ||
<title>pageEncoders</title> | <title>pageEncoders</title> | ||
</head> | </head> | ||
<body> | <body > | ||
<p class="MsoNormal"><b style=""><span style="font-size: 14pt;">How do | <p class="MsoNormal"><b style=""><span style="font-size: 14pt;">How do | ||
you get “cable length” from encoders?<o:p></o:p></span></b></p> | you get “cable length” from encoders?<o:p></o:p></span></b></p> | ||
Line 220: | Line 206: | ||
</body> | </body> | ||
</html> | </html> | ||
<div style="text-align: | <div style="text-align: left;"> | ||
[[Image: | [[Image:CEB3DP_OmronEncoderExample.png]] | ||
</div> | </div> | ||
<html> | <html> | ||
Line 239: | Line 225: | ||
</body> | </body> | ||
</html> | </html> | ||
---- | |||
<u>'''The example in Code:'''</u> | <u>'''The example in Code:'''</u> | ||
<html><br> | |||
<html> | |||
<pre><span style="color: rgb(126, 126, 126);">// 1 millimeter = 0.0032808399 feet</span><br><br>mm2ft = 0.0032808399; <span style="color: rgb(126, 126, 126);">// conversion variable</span><br>counts_per_rev = 300;<br><br>diameter = 40; <span style="color: rgb(126, 126, 126);">// mm</span><br>diameter = 40*mm2ft; <span style="color: rgb(126, 126, 126);">// convert shaft to ft.</span><br><br>circumference = diameter*pi;<br><br>distance_per_rev = circumference<br><br><span style="color: rgb(126, 126, 126);">//******************************************************//</span><br><span style="color: rgb(126, 126, 126);">// Example: distance = 1 ft. how many counts are recorded?</span><br><br>distance = 1;<br>counts = (counts_per_rev)*(1/distance_per_rev)*distance<br><br><span style="color: rgb(126, 126, 126);">// counts =</span><br><span style="color: rgb(126, 126, 126);">// </span><br><span style="color: rgb(126, 126, 126);">// 727.66</span><br><br><span style="color: rgb(126, 126, 126);">// rounded down to 727 as counts are integers</span><br><br><span style="color: rgb(126, 126, 126);">// Example: counts = 3200. How much distance travelled?</span><br><br>counts = 1000;<br>distance = (distance_per_rev)*(1/counts_per_rev)*counts<br><big><br><span style="color: rgb(126, 126, 126);">// distance =</span><br><span style="color: rgb(126, 126, 126);">// </span><br><span style="color: rgb(126, 126, 126);">// 1.3743 (feet)</span></big><br><br><span style="color: rgb(126, 126, 126);">//******************************************************//</span><br><br></pre> | <pre><span style="color: rgb(126, 126, 126);">// 1 millimeter = 0.0032808399 feet</span><br><br>mm2ft = 0.0032808399; <span style="color: rgb(126, 126, 126);">// conversion variable</span><br>counts_per_rev = 300;<br><br>diameter = 40; <span style="color: rgb(126, 126, 126);">// mm</span><br>diameter = 40*mm2ft; <span style="color: rgb(126, 126, 126);">// convert shaft to ft.</span><br><br>circumference = diameter*pi;<br><br>distance_per_rev = circumference<br><br><span style="color: rgb(126, 126, 126);">//******************************************************//</span><br><span style="color: rgb(126, 126, 126);">// Example: distance = 1 ft. how many counts are recorded?</span><br><br>distance = 1;<br>counts = (counts_per_rev)*(1/distance_per_rev)*distance<br><br><span style="color: rgb(126, 126, 126);">// counts =</span><br><span style="color: rgb(126, 126, 126);">// </span><br><span style="color: rgb(126, 126, 126);">// 727.66</span><br><br><span style="color: rgb(126, 126, 126);">// rounded down to 727 as counts are integers</span><br><br><span style="color: rgb(126, 126, 126);">// Example: counts = 3200. How much distance travelled?</span><br><br>counts = 1000;<br>distance = (distance_per_rev)*(1/counts_per_rev)*counts<br><big><br><span style="color: rgb(126, 126, 126);">// distance =</span><br><span style="color: rgb(126, 126, 126);">// </span><br><span style="color: rgb(126, 126, 126);">// 1.3743 (feet)</span></big><br><br><span style="color: rgb(126, 126, 126);">//******************************************************//</span><br><br></pre> | ||
</html> | </html> | ||
---- | |||
<u>'''Calculate Length Function:'''</u> Now that <span style="color: blue;">'''desired gripper position'''</span> & all 4 <span style="color: blue;">'''current lengths'''</span> are known, <span style="color: rgb(204, 102, 0);">'''desired length'''</span> for each cable can be calculated.*(current length is already known actually from previous function, will update code soon) | <u>'''Calculate Length Function:'''</u> Now that <span style="color: blue;">'''desired gripper position'''</span> & all 4 <span style="color: blue;">'''current lengths'''</span> are known, <span style="color: rgb(204, 102, 0);">'''desired length'''</span> for each cable can be calculated.*(current length is already known actually from previous function, will update code soon) | ||
Line 333: | Line 321: | ||
<pre> | <pre> | ||
| | ||
PWM code coming soon. | |||
| | ||
</pre> | </pre> | ||
Line 343: | Line 332: | ||
---- | |||
<html> | <html> | ||
Line 422: | Line 411: | ||
</body> | </body> | ||
</html> | </html> | ||
---- | |||
Revision as of 21:23, 20 December 2011
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.
Two video animations, originally made as Java applets, illustrate two such designs:
http://img.youtube.com/vi/Il1stSJcZTU/0.jpg http://img.youtube.com/vi/0HDd9J_Cc14/0.jpg
Logic Flowchart:
Sample Source Code:
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.
How do
you get “cable length” from encoders?
An Example:
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 = 3200. 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.
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
IRC Online Meeting Schedule: This is temporary section I'm experimenting with which doesn't quite belong here.
IRC Experimental Meeting Test Chart: This chart is used to display group meeting times on the OSE Internet Relay Chat (IRC) http://opensourceecology.org/wiki/Irc where groups can discuss project ideas and progress with realtime feedback. Group member names, IRC chat usernames, and status of sub-projects are listed.
Task | Name/Pseudonym | IRC Username | Status of Project | Extra |
---|---|---|---|---|
Motor Testing | vc_nepo | vc_nepo | 10 % | Link |
Encoder | User B | userBonIRC | 20 % | |
Material Spec | User C | userConIRC | Complete |