Shape-Changing Rotacaster Flexi-Bot

LEGO Mindstorms LEGO Mindstorms Videos My NXT Robots NXC - 'C' for Mindstorms Rotacaster Omni-Wheels Published September 16, 2010 at 12:00 am No Comments

The Shape-Changing Rotacaster Flexi-Bot acts like a Chameleon, but instead of changing colour, it can morphs into a variety of different  leg configurations. The front and rear pairs of arms are controlled as a pairs change the configuration of the Rotacaster Omni-wheels relative to the Robots body. Each Rotacaster Omni-wheel is driven individually via a Small Lego Power Functions Motor. The Arm pairs are driven individually by a pair of Lego Mindstorms NXT Servo Motors.

Rotacaster Flex-Bot

The home position for the arms is controlled via a set of 4x Lego Mindstorms RCX type Touch Sensors before the position of the NXT Servo Motors is set. The Power Function Motors are controlled via a Hitechnic Infra-red Link Sensor and 2x Lego Power Function Infra-red receivers. The Robot is controlled via a Sony PlayStation2 Controller interfaced to a Mindsensor PSP-Nx-v3: Sony PlayStation2 Controller interface for the NXT.

Rotacaster Flex-Bot


Lego Mindstorms NXT Rotacaster Flexi-Bot in Action!

I was forced to make a few minor changes between the Robot in the Video and the Photographs to accommodate the size of the stage. I was forced to change the gear ratio by a factor of  1:3 for the drive to the Rotacasters instead of the pictured direct-drive. This was primarily to slow it down so I was able to keep it on the mat.

The other change was to move the Battery Box for the PowerFunction Motors, from under the NXT to beside it, to aid in ease of battery changing.

Rotacaster Flex-Bot

The Flexi-Bot does work on carpet, but due to the weight of the Robot it bogs down somewhat. Also the Rotacasters don't have the surface area to ensure good tracking with the wheels off-set from each other. Larger Rotacasters would solve this issue I feel. But, most Robot designs tend to be somewhat lighter than this example. My post: Rotacaster Omni-wheels in Action! preforms very well on my 100% wool carpet.

Rotacaster Flex-Bot

All-in-all, I'm very happy with the Flexi-Bot results. For it to preform at it's best it needs a large floor space of at least 5m X 5m. The Rotacasters are at their best on polished wooden or Vinyl floor coverings, which I lack in a large enough scale to allow me too enjoy all the fun the Robot offers.

Rotacaster Flex-Bot

Buy Rotacaster Omni-wheels

Rotacaster Flex-Bot

Rotacaster Flex-Bot

Rotacaster Flex-Bot

NXC Source Code:

"View" "Source

  1. /* ===================================================
  2.  
  3.            ***********************************
  4.            ****** Rotacaster Flexi Bot  ******
  5.            ***********************************
  6.            
  7.    =================================================== */
  8.  
  9. #define PS2           S1     // Port Number
  10. #define F_Touch       S2     // Port Number
  11. #define R_Touch       S3     // Port Number
  12. #define PF_CTL        S4     // Port Number
  13. #define ADDR          0×02
  14. #define Deg2Rot       360
  15. #define FrontSW       SENSOR_2
  16. #define RearSW        SENSOR_3
  17. #include "PSP-Nx-lib.nxc"
  18.  
  19. const byte PlayStation  =  PS2;
  20. const int Degrees = (Deg2Rot * 1);
  21.  
  22. int Position, MovePosition, PositionFront, PositionRear, Direction;
  23.  
  24. /* ===================================================
  25.              Check & Display Sensors State
  26.    =================================================== */
  27.  
  28. task DisplayData()
  29. {
  30.   ClearScreen();
  31.   while (true)
  32.   {
  33.     TextOut(0,  LCD_LINE1, "Front Sw =       ");
  34.     NumOut(80, LCD_LINE1, FrontSW);
  35.     TextOut(0,  LCD_LINE2, "Rear Sw  =       ");
  36.     NumOut(80, LCD_LINE2, RearSW);
  37.     TextOut(0,  LCD_LINE3, "Position =       ");
  38.     NumOut(75, LCD_LINE3, Position);
  39.     TextOut(0,  LCD_LINE4, "Direction =      ");
  40.     NumOut(75, LCD_LINE4, Direction);
  41.     TextOut(0,  LCD_LINE7, "PosF       ");
  42.     NumOut(30, LCD_LINE7, PositionFront);
  43.     TextOut(50,  LCD_LINE7, "PosR       ");
  44.     NumOut(80, LCD_LINE7, PositionRear);
  45.     Wait (50);
  46.   }
  47. }
  48.  
  49.  
  50. /* ===================================================
  51.                     Initilize the Robot
  52.    =================================================== */
  53.  
  54. void Initilize()
  55. {
  56.   OnFwd(OUT_AB, 75);
  57.   Wait(750);
  58.   Off(OUT_AB);
  59.  
  60.   do
  61.   {
  62.     OnRev(OUT_A, 100);
  63.     Wait (50);
  64.   }
  65.   while (RearSW != true)
  66.  
  67.   Off(OUT_A);
  68.   Wait(100);
  69.   ResetTachoCount(OUT_A);
  70.  
  71.  
  72.   do
  73.   {
  74.     OnRev(OUT_B, 100);
  75.     Wait (50);
  76.   }
  77.   while (FrontSW != true)
  78.  
  79.  Off(OUT_AB);
  80.   Wait(100);
  81.  
  82.   PlayTone(1400, 100);
  83.  
  84.   PositionFront = 0; PositionRear = 0;
  85. }
  86.  
  87.  
  88.  
  89.  
  90. /* ===================================================
  91.                     Move All Robot Legs
  92.    =================================================== */
  93.  
  94. void Legs(float Angle)
  95. {
  96.   if (PositionFront == PositionRear)
  97.   {
  98.       MovePosition = 0 – PositionRear + Angle;
  99.       if (MovePosition == 0 ) { return; }
  100.       if ( sign (MovePosition) == -1) { Direction = -100; } else Direction = 100;
  101.       Position = abs(MovePosition *100);
  102.       OnFwd(OUT_AB, Direction);
  103.       RotateMotor(OUT_AB, Direction, Position);
  104.       Off(OUT_AB);
  105.       PositionRear = Angle;
  106.       PositionFront = Angle;
  107.       PlayTone(500, 100);
  108.       return;
  109.   }
  110.  
  111.  
  112.   PlayTone(750, 100);
  113.   TextOut(0,  LCD_LINE1, "Angel=                       ");
  114.   NumOut(50, LCD_LINE1, Angle);
  115.   MovePosition = 0 – PositionRear + Angle;
  116.   if (MovePosition == 0 ) { return; }
  117.   if ( sign (MovePosition) == -1) { Direction = -100; } else Direction = 100;
  118.   Position = abs(MovePosition *100);
  119.   OnFwd(OUT_A, Direction);
  120.   RotateMotor(OUT_A, Direction, Position);
  121.   Off(OUT_A);
  122.   PositionRear = Angle;
  123.   PlayTone(500, 100);
  124.  
  125.   MovePosition = 0 – PositionFront + Angle;
  126.   if (MovePosition == 0 ) { return; }
  127.   if ( sign (MovePosition) == -1) { Direction = -100; } else Direction = 100;
  128.   Position = abs(MovePosition *100);
  129.   OnFwd(OUT_B, Direction);
  130.   RotateMotor(OUT_B, Direction, Position);
  131.   Off(OUT_B);
  132.   PositionFront = Angle;
  133.   PlayTone(500, 200);
  134. }
  135.  
  136.  
  137. /* ===================================================
  138.                     Move Robot Front Legs ‘F’
  139.    =================================================== */
  140.  
  141. void LegsF(float Angle)
  142. {
  143.   PlayTone(750, 100);
  144.   MovePosition = 0 – PositionFront + Angle;
  145.   if (MovePosition == 0 ) { return; }
  146.   if ( sign (MovePosition) == -1) { Direction = -100; } else Direction = 100;
  147.   Position = abs(MovePosition *100);
  148.   OnFwd(OUT_B, Direction);
  149.   RotateMotor(OUT_B, Direction, Position);
  150.   Off(OUT_B);
  151.   PositionFront = Angle;
  152.   PlayTone(500, 100);
  153. }
  154.  
  155.  
  156. /* ===================================================
  157.                     Move Robot Rear Legs’R’
  158.    =================================================== */
  159.  
  160. void LegsR(float Angle)
  161. {
  162.   PlayTone(750, 100);
  163.   MovePosition = 0 – PositionRear + Angle;
  164.   if (MovePosition == 0 ) { return; }
  165.   if ( sign (MovePosition) == -1) { Direction = -100; } else Direction = 100;
  166.   Position = abs(MovePosition *100);
  167.   OnFwd(OUT_A, Direction);
  168.   RotateMotor(OUT_A, Direction, Position);
  169.   Off(OUT_A);
  170.   PositionRear = Angle;
  171.   PlayTone(500, 100);
  172. }
  173.  
  174.  
  175. /* ===================================================
  176.                         Main Tasks
  177.    =================================================== */
  178.  
  179. task main()
  180. {
  181.   ResetSensor(F_Touch);
  182.   ResetSensor(R_Touch);
  183.  
  184.   SetSensorLowspeed(PS2);
  185.   SetSensor(F_Touch, SENSOR_TOUCH);
  186.   SetSensor(R_Touch, SENSOR_TOUCH);
  187.   SetSensorMode(F_Touch, IN_MODE_BOOLEAN);
  188.   SetSensorMode(R_Touch, IN_MODE_BOOLEAN);
  189.   ClearSensor(R_Touch);
  190.   ClearSensor(F_Touch);
  191.  
  192.   SetSensorLowspeed(PF_CTL);
  193.         Wait (10);
  194.        
  195.   psp currState;
  196.   start DisplayData;
  197.  
  198.   RotateMotor(OUT_AB, 100, 360);
  199.   Off(OUT_AB);
  200.  
  201.   Initilize();
  202.  
  203. /*————————————–
  204.   PS2 Controller button layout:
  205. —————————————-
  206.  
  207.       L1                R1
  208.       L2                R2
  209.  
  210.       d                 triang
  211.    a     c         square     circle
  212.       b                  cross
  213.  
  214.      l_j_b              r_j_b
  215.      l_j_x              r_j_x
  216.      l_j_y              r_j_y
  217.  
  218. ————————————– */
  219. /*
  220.   bits as follows:
  221.    b1:   a b c d x r_j_b l_j_b x
  222.    b2:   square cross circle triang R1 L1 R2 L2
  223. */
  224.  
  225.   while (true)
  226.   {
  227.         Off(OUT_AB);
  228.  
  229.         PSP_ReadButtonState(PlayStation, ADDR, currState);
  230.  
  231.         if (currState.square != true) { Legs(90); }
  232.  
  233.         if (currState.cross != true) { Legs(45); }
  234.        
  235.         if (currState.triang != true) { Legs(135); }
  236.  
  237.         if (currState.circle != true) { Legs(0); }
  238.  
  239.         if (currState.l1 != true) { LegsF(45); }
  240.        
  241.         if (currState.r1 != true) { LegsR(45); }
  242.  
  243.         if (currState.l2 != true) { LegsF(135); }
  244.  
  245.         if (currState.r2 != true) { LegsR(135); }
  246.  
  247.         if (currState.d != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_REV, PF_CMD_REV); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_FWD, PF_CMD_FWD);
  248.         if (currState.d == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); }}
  249.  
  250.         if (currState.b != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_FWD, PF_CMD_FWD); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_REV, PF_CMD_REV);
  251.         if (currState.b == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); } }
  252.  
  253.         if (currState.a != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_REV, PF_CMD_FWD); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_FWD, PF_CMD_REV);
  254.         if (currState.a == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); } }
  255.  
  256.         if (currState.c != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_FWD, PF_CMD_REV); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_REV, PF_CMD_FWD);
  257.         if (currState.c == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); } }
  258.  
  259.         if (currState.l_j_b != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_REV, PF_CMD_REV); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_REV, PF_CMD_REV);
  260.         if (currState.l_j_b == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); } }
  261.  
  262.         if (currState.r_j_b != true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_FWD, PF_CMD_FWD); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_FWD, PF_CMD_FWD);
  263.         if (currState.r_j_b == true) { HTPFComboDirect(PF_CTL, PF_CHANNEL_1, PF_CMD_STOP, PF_CMD_STOP); HTPFComboDirect(PF_CTL, PF_CHANNEL_2, PF_CMD_STOP, PF_CMD_STOP); } }
  264.  
  265.         Wait (50);
  266.   }
  267.  
  268. }
  269.  
  270.  
  271.  
  272.  

 

Rotacaster Flex-Bot

Buy Rotacaster Omni-wheels

Link to this post!

Tags: , , , , , , , , , , , , , , , , , , , , , , ,

Leave a Reply

Your email address will not be published. Required fields are marked *

*



You may use these HTML tags and attributes: <a href="" title=""> <abbr title=""> <acronym title=""> <b> <blockquote cite=""> <cite> <code> <del datetime=""> <em> <i> <q cite=""> <strike> <strong> <font color="" face="" size=""> <span style="">

The Best of the Best, in LEGO Mindstorms NXT Publications for Your Bookshelf!