Disk-on-Disk Rolling Manipulation Project - Revision history

Ji-Chul Ryu at 02:18, 31 July 2013

2013-07-31T02:18:46Z

← Older revision		Revision as of 21:18, 30 July 2013
Line 88:		Line 88:
	<li>If something goes wrong with the motor, press 'q' to quit the program.</li>		<li>If something goes wrong with the motor, press 'q' to quit the program.</li>
	</ol>		</ol>

			===Codes===
			* [[Media:QnxKit.zip]]: The codes running on the QNX machine. The control algorithm is implemented in this codes.
			* [[Media:Vision.zip]]: The codes running on the vision computer. It tracks dots and sends the position data to the QNX machine through TCP/IP.
			* [[Media:QnxMatlab.zip]]: The codes running on the host computer. Data sent from the QNX machine is collected on the host computer using this Matlab codes.

Ji-Chul Ryu: /* Experimental Set-up */

2013-07-31T02:12:54Z

Experimental Set-up

← Older revision		Revision as of 21:12, 30 July 2013
Line 18:		Line 18:

	==Experimental Set-up==		==Experimental Set-up==
	'''While the detail of the experimental set-up procedure is written in the manual ~~here~~, we briefly present it here as follows.''' The hand is the lower disk, actuated by a harmonic drive DC motor (Harmonic Drive RH-8D 6006) equipped with a 50:1 harmonic drive gearhead and a 500 ppr quadrature encoder giving 100,000 counts per revolution at the output shaft. The commanded current input to the motor is provided through a motor amplifier (Copley Controls Junus 800-1468). The disk-on-disk system is mounted on an air table that provides frictionless support in a plane tilted 79.0 degrees with respect to horizontal (98.2 % of full gravity). Both hand and object are made of 1/4-inch thick acrylic and the object is encircled by a rubber band to increase friction.		'''While the detail of the experimental set-up procedure is written in the manual (see [[Media:DiskOnDisk_Setup.doc]]), we briefly present it here as follows.''' The hand is the lower disk, actuated by a harmonic drive DC motor (Harmonic Drive RH-8D 6006) equipped with a 50:1 harmonic drive gearhead and a 500 ppr quadrature encoder giving 100,000 counts per revolution at the output shaft. The commanded current input to the motor is provided through a motor amplifier (Copley Controls Junus 800-1468). The disk-on-disk system is mounted on an air table that provides frictionless support in a plane tilted 79.0 degrees with respect to horizontal (98.2 % of full gravity). Both hand and object are made of 1/4-inch thick acrylic and the object is encircled by a rubber band to increase friction.

	The hand control algorithm runs on a PC104 stack with a QNX real-time operating system (RTOS). In addition to the angular position data from the encoder of the hand, the controller utilizes the state of the object disk, which is determined using a high-speed vision system. The vision system, consisting of a PhotonFocus TrackCam camera, a Microenable III frame grabber, and a Windows PC, tracks two markers on the disk at 800 Hz, allowing estimation of the position and orientation of the disk at 800 Hz. The vision program, written in C++, sends the orientation of the disk to the controller PC104 stack via TCP/IP. The tracking markers may be high contrast passive markers (e.g., black on white) or active markers (LEDs in the current implementation).		The hand control algorithm runs on a PC104 stack with a QNX real-time operating system (RTOS). In addition to the angular position data from the encoder of the hand, the controller utilizes the state of the object disk, which is determined using a high-speed vision system. The vision system, consisting of a PhotonFocus TrackCam camera, a Microenable III frame grabber, and a Windows PC, tracks two markers on the disk at 800 Hz, allowing estimation of the position and orientation of the disk at 800 Hz. The vision program, written in C++, sends the orientation of the disk to the controller PC104 stack via TCP/IP. The tracking markers may be high contrast passive markers (e.g., black on white) or active markers (LEDs in the current implementation).

Ji-Chul Ryu: /* Amplifier Set-up */

2013-07-31T01:57:17Z

Amplifier Set-up

← Older revision		Revision as of 20:57, 30 July 2013
Line 27:		Line 27:
	<ol>		<ol>
	<li>Connect the output of a DC power supply of 48 V to +HV and GND terminals of the amp using the following diagram. (Junus amp data sheets: [http://www.copleycontrols.com/motion/pdf/Junus.pdf http://www.copleycontrols.com/motion/pdf/Junus.pdf])</li>		<li>Connect the output of a DC power supply of 48 V to +HV and GND terminals of the amp using the following diagram. (Junus amp data sheets: [http://www.copleycontrols.com/motion/pdf/Junus.pdf http://www.copleycontrols.com/motion/pdf/Junus.pdf])</li>
			[[File:Junus_power.jpg\|x250px]]
	<li>Using the USB to RS-232 cable, connect the amp to your PC (Install the driver: ‎[[Media:Usb-serial-driver.zip]])</li>		<li>Using the USB to RS-232 cable, connect the amp to your PC (Install the driver: ‎[[Media:Usb-serial-driver.zip]])</li>
	<li>Download and install CME2 (Copley Motion Explorer2) from [http://www.copleycontrols.com/Motion/Downloads/index.html http://www.copleycontrols.com/Motion/Downloads/index.html].</li>		<li>Download and install CME2 (Copley Motion Explorer2) from [http://www.copleycontrols.com/Motion/Downloads/index.html http://www.copleycontrols.com/Motion/Downloads/index.html].</li>

Ji-Chul Ryu: /* QNX (PC104) System */

2013-07-31T01:42:08Z

QNX (PC104) System

← Older revision		Revision as of 20:42, 30 July 2013
Line 51:		Line 51:
	<li>Your code is now on the QNX machine and ready to execute.</li>		<li>Your code is now on the QNX machine and ready to execute.</li>
	</ol>		</ol>


	* '''I/O [IoHardware and individual board drivers]'''		* '''I/O [IoHardware and individual board drivers]'''
Line 61:		Line 60:
	[[File:Dio_port.jpg\|x250px]]		[[File:Dio_port.jpg\|x250px]]
	</ol>		</ol>


	* '''Code: control loop and vision data receiving'''		* '''Code: control loop and vision data receiving'''
	<ol>		<ol>
			<li>The control algorithm is implemented in [SampleLoopTask::Task() in SampleLoopTask.C]. There is a feedforward model for the motor in [motor.C/h], which calculates the torque (current).</li>
	<li></li>
			<li>The camera triggering and communication happens in this loop as well. A trigger pulse is sent to the frame grabber to take a picture. See the related codes in [VisionNet.C/h] that is modified from [MatlabNet.C/h]</li>
	<li></li>
	<li></li>
	</ol>		</ol>


	* '''MATLAB communication/data logging [MatlabNet]'''		* '''MATLAB communication/data logging [MatlabNet]'''

Ji-Chul Ryu: /* Tasks Accomplished */

2013-07-31T00:40:02Z

Tasks Accomplished

← Older revision		Revision as of 19:40, 30 July 2013
Line 8:		Line 8:
	* spin at a constant velocity.		* spin at a constant velocity.
	We constrain the motion of the circular hand to rotation about its center. We derive control laws that stabilize the object to the balanced position under the kinematic assumption of rolling at all times. The basin of attraction is reduced when the contact is modeled using Coulomb friction, but it is still large with large friction coefficients. This work is successfully implemented using high-speed vision feedback.		We constrain the motion of the circular hand to rotation about its center. We derive control laws that stabilize the object to the balanced position under the kinematic assumption of rolling at all times. The basin of attraction is reduced when the contact is modeled using Coulomb friction, but it is still large with large friction coefficients. This work is successfully implemented using high-speed vision feedback.

			'''The video of this work can be viewed at [http://vimeo.com/54405698 http://vimeo.com/54405698].'''

	==Publication==		==Publication==

Ji-Chul Ryu: /* Experimental Set-up */

2013-07-30T22:54:46Z

Experimental Set-up

← Older revision		Revision as of 17:54, 30 July 2013
Line 19:		Line 19:

	The hand control algorithm runs on a PC104 stack with a QNX real-time operating system (RTOS). In addition to the angular position data from the encoder of the hand, the controller utilizes the state of the object disk, which is determined using a high-speed vision system. The vision system, consisting of a PhotonFocus TrackCam camera, a Microenable III frame grabber, and a Windows PC, tracks two markers on the disk at 800 Hz, allowing estimation of the position and orientation of the disk at 800 Hz. The vision program, written in C++, sends the orientation of the disk to the controller PC104 stack via TCP/IP. The tracking markers may be high contrast passive markers (e.g., black on white) or active markers (LEDs in the current implementation).		The hand control algorithm runs on a PC104 stack with a QNX real-time operating system (RTOS). In addition to the angular position data from the encoder of the hand, the controller utilizes the state of the object disk, which is determined using a high-speed vision system. The vision system, consisting of a PhotonFocus TrackCam camera, a Microenable III frame grabber, and a Windows PC, tracks two markers on the disk at 800 Hz, allowing estimation of the position and orientation of the disk at 800 Hz. The vision program, written in C++, sends the orientation of the disk to the controller PC104 stack via TCP/IP. The tracking markers may be high contrast passive markers (e.g., black on white) or active markers (LEDs in the current implementation).

			[[File:exp_schematic.jpg\|center\|x330px]]

	===Amplifier Set-up===		===Amplifier Set-up===

Ji-Chul Ryu: /* QNX (PC104) System */

2013-07-30T21:30:57Z

QNX (PC104) System

← Older revision		Revision as of 16:30, 30 July 2013
Line 51:		Line 51:
	* '''I/O [IoHardware and individual board drivers]'''		* '''I/O [IoHardware and individual board drivers]'''
	<ol>		<ol>
			<li>The encoder board, MSI-P404-8: 8 encoder channels. Each channel takes in the A and B channels of a single-ended encoder and returns the encoder count using the function GetEncoderCount().</li>
	<li></li>
			<li>The analog output board, Ruby-1612-XT (Diamond Systems Corp.): 16 analog outputs (12-bit resolution). To set and output to a single channel, use the function WriteAnalogCh(ch, val). To set a value to be output, use SetAnalogOut(ch, val); to actually output this value, ProcessOutput() must be called. The pinout is in the figure below.</li>
	<li></li>
			[[File:AO_board.jpg]]
	<li></li>
			<li>The digital I/O board, 104-DIO-48E(Acces I/O products, inc.); There are 6 digital I/O ports on the 104-DIO-48E digital I/O board as well as 3 more on the analog output board. The port and pin structure is shown below. ReadDigitalBit(bit) and WriteDigitalBit(bit, state) functions directly read/write bits whereas GetDigitalInBit(bit) and SetDigitalOutBit(bit, state) are effective after calling ProcessInput() and ProcessOutput(), respectively.</li>
			[[File:Dio_port.jpg\|x250px]]
	</ol>		</ol>

Line 63:		Line 65:
	<li></li>		<li></li>
	</ol>		</ol>


	* '''MATLAB communication/data logging [MatlabNet]'''		* '''MATLAB communication/data logging [MatlabNet]'''

Ji-Chul Ryu: /* QNX (PC104) System */

2013-07-30T19:52:05Z

QNX (PC104) System

← Older revision		Revision as of 14:52, 30 July 2013
Line 36:		Line 36:

	===QNX (PC104) System===		===QNX (PC104) System===
			* '''Communication and uploading code'''
	<ol>		<ol>
	<li>On the host PC, set a static IP address. For example, with leaving the rest blank,</li>		<li>On the host PC, set a static IP address. For example, with leaving the rest blank,</li>
Line 45:		Line 46:
	<li>On the host, open a second command prompt window and go to the directory containing the code you wish to upload to the QNX machine. "make put" will act the same way as "make" and also send the executable to the target PC using the wput function.</li>		<li>On the host, open a second command prompt window and go to the directory containing the code you wish to upload to the QNX machine. "make put" will act the same way as "make" and also send the executable to the target PC using the wput function.</li>
	<li>Your code is now on the QNX machine and ready to execute.</li>		<li>Your code is now on the QNX machine and ready to execute.</li>
			</ol>


			* '''I/O [IoHardware and individual board drivers]'''
			<ol>
	<li></li>		<li></li>
	<li></li>		<li></li>
	<li></li>		<li></li>
			</ol>


			* '''Code: control loop and vision data receiving'''
			<ol>
	<li></li>		<li></li>
	<li></li>		<li></li>
			<li></li>
			</ol>

			* '''MATLAB communication/data logging [MatlabNet]'''
			<ol>
			<li>This opens a TCP/IP socket connection with the host PC.</li>
			<li>Every time through the control loop, the output (num[]) is added to the buffer.</li>
			<li>The number of data points to be sent can be changed in the MatlabNet.h file (#define MATLAB_NET_NUM_CH) and must also be changed in the MATLAB code.</li>
			<li>To run the MATLAB code, go to the QnxMatlab folder.</li>
			<li>Run "rtplot.m" and click on the start button.</li>
	</ol>		</ol>

Ji-Chul Ryu at 19:00, 30 July 2013

2013-07-30T19:00:36Z

@@ Line 1: / Line 1: @@
 ==Overview==
 Nonprehensile manipulation primitives such as rolling, sliding, pushing, and throwing are commonly used by humans but are often avoided by robots, who generally use grasping. Dynamic nonprehensile manipulation raises challenges in high-speed sensing and control, as the manipulated object is not in static equilibrium throughout the process which would be the case with standard grasping. An advantage, however, is that dynamics can be exploited to help the robot control object motions that would otherwise be impossible. Our long-term goal is to develop a unified framework for planning and control of dynamic robotic manipulation. A typical manipulation plan consists of a sequence of manipulation primitives chosen from a library of primitives, with each primitive equipped with its own feedback controller. Problems of interest include planning the motion of the manipulator to achieve the desired motion of the object and feedback control to stabilize the desired trajectory. As a first step to understand the nature of dynamic nonprehensile manipulation, we study feedback stabilization of a canonical rolling problem:  balancing a disk-shaped object on top of a disk-shaped manipulator (referred to as the hand) in a vertical plane.
@@ Line 35: / Line 36: @@
 ===QNX (PC104) System===
 ===Running the Program===

Ji-Chul Ryu: /* Amplifier Set-up */

2013-07-30T18:16:21Z

Amplifier Set-up

← Older revision		Revision as of 13:16, 30 July 2013
Line 30:		Line 30:
	<li>Check the tracking of the input current by running the menu [Amplifier]-[Scope]</li>		<li>Check the tracking of the input current by running the menu [Amplifier]-[Scope]</li>
	[[File:Junus_scope.jpg\|x250px]]		[[File:Junus_scope.jpg\|x250px]]
			<li>Complete wiring using the following table.</li>
			[[File:amp_signal_J1.jpg\|200px]] [[File:amp_signal_J2.jpg\|400px]]
	</ol>		</ol>