{"id":13995,"date":"2021-10-05T01:54:56","date_gmt":"2021-10-05T05:54:56","guid":{"rendered":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/?p=13995"},"modified":"2021-10-05T01:54:56","modified_gmt":"2021-10-05T05:54:56","slug":"double-transducer-color-to-rotational-position","status":"publish","type":"post","link":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/double-transducer-color-to-rotational-position\/","title":{"rendered":"Double Transducer: Color to Rotational Position"},"content":{"rendered":"
\n

Color to Rotational Position<\/h2>\n<\/blockquote>\n

Our double transducer took color as an input, transforming it into rotational position.<\/p>\n

\"\"

The final double transducer, copy 1.<\/p><\/div>\n

\"\"

The second copy of the double transducer we made.<\/p><\/div>\n

The first part is the color sensor (at the top of the images), which reads what color is put in front of it. After turning it on, we make sure the color sensor is at the correct position, so we have to put a color in front of it and press the button, which makes 1\/10th of a full rotation, until the color sensor is pointing to the correct location on the color wheel. When a different color is put in front of the color sensor, the color sensor reads the color and spins the motor to point to the color we are reading. The position of the motor puts pressure on a different sensor. Depending on what location the second sensor is being pressed, the final motor turns a certain amount.<\/p>\n

Detail Shots<\/h2>\n
\"\"

Detail shot: the small pillars we added in order to stabilize the potentiometer input.<\/p><\/div>\n

\"\"

Detail shot: the arm attached to the stepper motor which puts pressure on the potentiometer.<\/p><\/div>\n

\"\"

Detail shot: the soldered board.<\/p><\/div>\n

\"\"

Detail shot: The second color sensor, with a busted LED that we had to replace.<\/p><\/div>\n

Progress Images<\/h2>\n
\"potentiometer

Our day 1 design for the potentiometer. Unstable, ultimately redone.<\/p><\/div>\n

\"\"

First attempt at getting the stepper motor to work<\/p><\/div>\n

\"\"

First working color sensor to stepper motor rotation to potentiometer read<\/p><\/div>\n

\"\"

Finished the soldering on the first board, and verified that the motor works.<\/p><\/div>\n

Discussion<\/h2>\n

The first day we spent the entire two hours of class trying to work with the force sensing circular potentiometer, trying to get a consistent reading on it. We fiddled with it for ages, trying to find something that could move and apply enough pressure to the potentiometer for it to consistently register. Our first attempt at this was to add weights to the pointer part of the arm that would apply pressure. However, by the end of it, it still wasn\u2019t working, and we had to consider our options. We came up with a few: first, we could continue working with the potentiometer, with our next steps being that we would move it to a more stable surface; and two, we could create what was basically our own potentiometer by moving a stepper motor with resistors surrounding it and measuring the change in voltage. However we did end up making the circular potentiometer work by creating a more stable surface, and adding support beams and weights to the arm. This was definitely the hardest part of the project.<\/p>\n

Something that initially seemed fairly daunting, was soldering. Neither of us had much experience with soldering in the past, and the number of pins that needed to be soldered to run the stepper motor was very scary. However, after the first 10-15 pins, the we picked up a feel for how to work the soldering iron and make pretty solders. The second board soldering process went by much faster, and overall would say that soldering feels fairly easy now especially considering where we started.<\/p>\n

One decision that would have changed everything about what we learned and how cool our project ended up being, is using the easy middle step that we had initially discussed. One of our three initial ideas was to use the brightness of a bulb to change a photoresistor resistance and measure that change. We would have had a much easier soldering step, which means we would likely not have been as comfortable as we are now with it, and it also would have removed the entire centerpiece of our final design, which was the color wheel to stepper motor interaction that lets us display color.<\/p>\n

Functional Block Diagram<\/h2>\n

 <\/p>\n

 <\/p>\n

\"\"<\/a><\/p>\n

Schematic<\/h2>\n

\"\"<\/p>\n

<\/h2>\n

Video<\/h2>\n
\nhttps:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-content\/uploads\/2021\/10\/epic-demo.mp4<\/a><\/video><\/div>\n

A video demonstration of the color wheel working. There is a slight delay between the color input and the movement of the motors; this is due to the calculations made to get the raw data from the sensors.<\/p>\n

Code<\/h2>\n
\/*\r\nDouble Transducer: Color to Rotational Position\r\n\r\n1. Reads values from the color sensor, \r\n2. Converts it into a degree value based on the color sensed from the color sensor\r\n3. Moves stepper motor stepwise until it reaches the number of degrees we got from the color sensor\r\n4. Reads potentiometer reading \r\n5. Translate potentiometer reading into an amount to move the final servo motor\r\n\r\nCredit: https:\/\/www.py4u.net\/discuss\/63122 for the code to convert rgb values to hsv values\r\n*\/\r\n#include <AccelStepper.h>\r\n#include <Servo.h>\r\n#include <Wire.h>\r\n#include \"Adafruit_TCS34725.h\"\r\n#include <LiquidCrystal_I2C.h>\r\n\r\n\r\nconst int STEP_PIN = 12; \/\/ A4988 \"STEP\" pin wired to Arduino pin 2 for stepper \r\nconst int DIR_PIN = 13; \/\/ A4988 \"DIRECTION\" pin wired to Arduino pin 3 for stepper motor\r\nconst int buttonPin = 2; \/\/ pin for button press\r\nconst int servoPin = 3;  \/\/ pin for controlling servo motor\r\nAdafruit_TCS34725 tcs = Adafruit_TCS34725(TCS34725_INTEGRATIONTIME_614MS, TCS34725_GAIN_1X);\r\nLiquidCrystal_I2C lcd(0x27, 16, 2); \/\/ initializes \r\n\r\ntypedef struct {\r\n    double h;       \/\/ angle in degrees\r\n    double s;       \/\/ a fraction between 0 and 1\r\n    double v;       \/\/ a fraction between 0 and 1\r\n} hsv;\r\n \r\nstatic hsv   rgb2hsv(float r, float g, float b);\r\n\r\n\/\/ converts rgb values to hsv values\r\nhsv rgb2hsv(float r, float g, float b) \r\n{\r\n    hsv         out;\r\n    double      min, max, delta;\r\n \r\n    min = r < g ? r : g;\r\n    min = min  < b ? min  : b;\r\n \r\n    max = r > g ? r : g;\r\n    max = max  > b ? max  : b;\r\n \r\n    out.v = max;                                \/\/ v\r\n    delta = max - min;\r\n    if (delta < 0.00001)\r\n    {\r\n        out.s = 0;\r\n        out.h = 0; \/\/ undefined, maybe nan?\r\n        return out;\r\n    }\r\n    if( max > 0.0 ) { \/\/ NOTE: if Max is == 0, this divide would cause a crash\r\n        out.s = (delta \/ max);                  \/\/ s\r\n    } else {\r\n        \/\/ if max is 0, then r = g = b = 0              \r\n        \/\/ s = 0, h is undefined\r\n        out.s = 0.0;\r\n        out.h = NAN;                            \/\/ its now undefined\r\n        return out;\r\n    }\r\n    if( r >= max )                           \/\/ > is bogus, just keeps compilor happy\r\n        out.h = ( g - b ) \/ delta;        \/\/ between yellow & magenta\r\n    else\r\n    if( g >= max )\r\n        out.h = 2.0 + ( b - r ) \/ delta;  \/\/ between cyan & yellow\r\n    else\r\n        out.h = 4.0 + ( r - g ) \/ delta;  \/\/ between magenta & cyan\r\n \r\n    out.h *= 60.0;                              \/\/ degrees\r\n \r\n    if( out.h < 0.0 )\r\n        out.h += 360.0;\r\n \r\n    return out;\r\n}\r\n\r\nServo serv;\r\n\r\n\/\/ make an AccelStepper motor object. \r\nAccelStepper myMotor(1, STEP_PIN, DIR_PIN);\r\n\r\nlong long count = 0;\r\nlong total = 0;\r\nlong sampleSize = 0;\r\n\r\nint calibPos = 0;\r\nint pos = 0;\r\nlong long setPosTimer = 0;\r\nlong long buttonTimer = 0;\r\n\r\nlong long \r\nint degree = 0;\r\nchar color[20];\r\n\r\n\r\nvoid setup(){\r\n  Serial.begin(9600); \/\/ begin Serial communication\r\n  pinMode(buttonPin, INPUT);\r\n  \/\/checks color sensor is working\r\n  Serial.println(\"setupr\");\r\n  if (tcs.begin()) {\r\n    Serial.println(\"Found sensor\");\r\n  } else {\r\n    Serial.println(\"No TCS34725 found ... check your connections\");\r\n    while (1);\r\n  } \r\n\r\n  \/\/ starts the display\r\n  lcd.begin();\r\n  lcd.backlight();\r\n  lcd.print(\"Hi!\");\r\n  \r\n  \/\/ you can change the below values as you'd like\r\n  myMotor.setMaxSpeed(150); \/\/ measured in steps per second\r\n  myMotor.setAcceleration(50); \/\/ measured in steps per second squared\r\n  serv.attach(servoPin);\r\n\r\n  setPosTimer = millis();\r\n  myMotor.moveTo(0);\r\n\r\n  while(myMotor.distanceToGo() != 0) {\r\n    myMotor.run();\r\n  }\r\n}\r\n\r\nvoid loop(){\r\n  \/\/ calculates color input\r\n  if (millis() - setPosTimer >= 5000 && millis() >= 10000) {\r\n    uint16_t r, g, b, c;\r\n    tcs.getRawData(&r, &g, &b, &c);\r\n    float red, green, blue;\r\n    tcs.getRGB(&red, &green, &blue);\r\n\r\n\r\n    red = red \/ 255;\r\n    green = green \/ 255; \r\n    blue = blue \/ 255;\r\n    \r\n    double h = rgb2hsv(red, green, blue).h;\r\n    int hue = int(h);\r\n    Serial.println(hue);\r\n\r\n    if (hue >= 0 && hue < 15) {\r\n      strncpy(color, \"red\", 3);\r\n    } else if (hue >= 15 && hue < 45){\r\n      strncpy(color, \"orange\", 6);\r\n    } else if (hue >= 45 && hue < 75){\r\n      strncpy(color, \"yellow\", 6);\r\n    } else if (hue >= 75 && hue < 150){\r\n      strncpy(color, \"green\", 5);\r\n    } else if (hue >= 150 && hue < 200){\r\n      strncpy(color, \"cyan\", 4);\r\n    } else if (hue >= 200 && hue < 255){\r\n      strncpy(color, \"blue\", 4);\r\n    } else if (hue >= 255 && hue < 285){\r\n      strncpy(color, \"purple\", 6);\r\n    } else if (hue >= 285 && hue < 315){\r\n      strncpy(color, \"pink\", 4);\r\n    } else if (hue >= 315 && hue < 360){\r\n      strncpy(color, \"red\", 3);\r\n    } else {\r\n      strncpy(color, \"N\/A\", 3);\r\n    }\r\n    lcd.home();\r\n    lcd.print(\"Color: \");\r\n    lcd.print(color);\r\n    strncpy(color, \"          \", 10);\r\n\r\n    \/\/ moves stepper motor\r\n    int stepperTarget = map(hue, 0, 360, 0, 200) + calibPos;\r\n    Serial.print(\"Current pos and Target pos: \");\r\n    Serial.print(pos);\r\n    Serial.print(\", \");\r\n    Serial.println(stepperTarget);\r\n    myMotor.moveTo(stepperTarget);\r\n    pos = stepperTarget;\r\n    setPosTimer = millis();\r\n    lcd.setCursor(0, 1);\r\n    lcd.print(\"moving to: \");\r\n    lcd.print(stepperTarget);\r\n\r\n  }\r\n  \r\n  \/\/ Use button to calibrate without changing pos\r\n  if (digitalRead(buttonPin) == HIGH && millis() - buttonTimer >= 1000){\r\n    Serial.println(\"Press\");\r\n    calibPos += 20;\r\n    myMotor.moveTo(pos);\r\n    buttonTimer = millis();\r\n  }\r\n\r\n  \/\/ moves servo motor\r\n  if ( count % 100 == 0 ) {\r\n    int servPos = map(total\/100, 0, 1023, 10, 90);\r\n    Serial.println(servPos);\r\n    serv.write(servPos);\r\n    total = 0;\r\n  }\r\n  total += analogRead(A0);\r\n  count++;\r\n  myMotor.run();\r\n\r\n}<\/pre>\n
 <\/p>\n","protected":false},"excerpt":{"rendered":"
Color to Rotational Position Our double transducer took color as an input, transforming it into rotational position. The first part is the color sensor (at the top of…<\/p>\n","protected":false},"author":202,"featured_media":14025,"comment_status":"closed","ping_status":"closed","sticky":false,"template":"","format":"standard","meta":[],"categories":[86],"tags":[],"_links":{"self":[{"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/posts\/13995"}],"collection":[{"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/posts"}],"about":[{"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/users\/202"}],"replies":[{"embeddable":true,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/comments?post=13995"}],"version-history":[{"count":7,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/posts\/13995\/revisions"}],"predecessor-version":[{"id":14091,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/posts\/13995\/revisions\/14091"}],"wp:featuredmedia":[{"embeddable":true,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/media\/14025"}],"wp:attachment":[{"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/media?parent=13995"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/categories?post=13995"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/courses.ideate.cmu.edu\/60-223\/f2021\/work\/wp-json\/wp\/v2\/tags?post=13995"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}