Robot Drummer

From Mech
Jump to navigationJump to search

ME_333_final_projects

Team Members

Niecestro-Lee-By
  • Bobby By: Senior in Electrical Engineering
  • Agatha Lee: Master Student in Biomedical Engineering
  • Dan Niecestro: Senior in Mechanical Engineering


Overview

This project consisted of creating motor control PICs that will make it easy for anyone to do high-speed encoder-based feedback control of brushed DC motors with only a few dollars of hardware and a cable to connect to Matlab on a PC. The "master" PIC communicates with the PC and any number of "slave" PICs, two in our case. The master PIC takes the program written in Matlab, communicates it to the slave PICs and coordinates the initiation of moves by the slave PICs. To demonstrate motor control, the Robot Drummer was created.

Mechanical Design

Mechanical Overview

In this project, we were asked to present motor control of two separate motors running simultaneously. A few different ideas were suggested and others were gathered through brainstorming. In the end, it was thought the simplest way to show motor control to the eye and be aesthetically pleasing was to make a small drum set.

  • pic of setup here*

This drum set consisted of a base, a drum pad and two drum sticks. All the parts were manufactured in the machine shop that we have access to with materials supplied. The motors are removable and can be switched by loosening the brackets that hold them down. One of the main considerations was reusability of the motors and allows easy removal or switching of motors from our device.

Base

The base was made in a U shape; this was done to allow the motors to hang over the insides and share the same drum pad, as seen above. Also, small legs were planted under the base so that when the motor rotated, the drumsticks would not hit the surface underneath. Both the legs and the main base was made of wood. To make it look more aesthetically pleasing, we put some black cardboard over it. We chose the cardboard rather than painting it because the cardboard gives that look of being the side of a drum and we did not want to get paint on the motors.

Securing Motor to Base

The motors were secured to the base using two brackets. The first bracket went around the circular part of our motor to hold the motor down and prevent side to side movement. Next, around the square part, a small, thin bracket was used to prevent the motor from moving up and down and slipping. Both brackets were set in place using screws to allow the bracket to open and close with ease. After securing it in place, the motors did not move at all and proved to be very secure.

Drum Pad

The drum pad is elevated off the base to allow the ends of the drumstick to hit it without hitting the base. Like the base, the drum pad is made of wood as well. The drum pad then was covered in a thick poster board material to dampen the sound since the metal hitting the wood was rather loud. This also gave the look of a drum pad. Also, the number 13 was put on the pad to represent our team number.

Drum Sticks

This was the most intensive part to make, but in the end, it is a very simple concept. It was a rather difficult concept because there was a large number of trials and different ways of creating them. It was decided that a light weight structure should be made to ensure that the motor could support it, therefore aluminum sheet metal was used. Basically, two L beams were made mirrored of each other and one hole was drilled for a screw on each side at the base of each beam. This was to connect to another small beam to go on the other side which will make a simple collet and a nice force fit on the shaft of the motor. To connect the two L beams together, rivets had to be used as spot welding aluminum is not very effective. Only three rivets were placed on the beam because a small circular rod of aluminum was added at the end of the beam. The beam had to open up and the rod was place in the middle, where two holes were drilled to prevent the rod from moving. Lastly, we wrapped it in a yellow glossy paper to make them look more like drumsticks; however, these coverings are not exactly round because it had to attach to the beam itself, which isn’t round. The result showed that it created a very nice force fit which had very little to no slipping on the motor shaft.

Electrical Design

Component List

PartPart No.Qty
PIC18F4520 Prototyping Board---3
Microchip 8-bit PIC MicrocontrollerPIC18F45201
Microchip 8-bit PIC MicrocontrollerPIC18F44312
RS232 CableTTL-232R1
Pittman Motor with EncoderGM82242
Hex Inverter ChipSN74HC041
H-Bridge ChipL293D2
10K Resistor---2

Set Up

All of the components, except the Pittman motors, were powered with 5V DC. The Pittman motors were powered with 12V DC.

PICs

Two kinds of PICs were used: one "master" 18F4520 and two "slaves" 18F4431. The 18F4431 has a built in quad encoder, which makes it very useful for motors. This eliminates the need of a counter chip, such as a LS7083. The three PICs communicated via I2C, which enabled us to control the two motors by telling the master PIC what to do through Matlab. To establish I2C communication, 3 connections were needed. First, the GO line was connected from pin 7 of the master PIC to pin 18 of all slave PICs. The SCL line and SDA line were connected from pin 18 and pin 23 of the master PIC to pin 24 and pin 23 of all slave PICs, respectively. Also note that the SCL and SDA lines needed a 10 kiloohm pull-up resistor.

RS232

The TTL-232R has six color-coded wires, but only 3 were required with this project. The black GROUND wire was connected to PIC ground, the orange Tx wire was connected to pin 26 of the master PIC and the yellow Rx wire was connected to pin 25 of the master PIC.

H-Bridge

The slave PICs send an individual PWM to a L293D H-bridge. This PWM determines the speed of each motor. The motor is at rest at a 50% duty cycle and is at its maximum speed at 0 and 100% duty cycles. Pin 16 of the slave PICs was connected to pin 2 of a L293D. The H-bridge needed to be powered with +12V on pin 8, +5V on pin 1 and grounded on pins 4 and 5. Pin 16 was also powered with +5V and pins 12 and 13 were grounded to minimize noise.

Hex Inverter

Pin 16 of the slave PICs was also run through the hex inverter chip (pin 1 or pin 13). The output of the hex inverter (pin 2 or pin 12) was sent to pin 7 of a L293D. Pin 14 was powered with +5V and pin 7 was grounded.

Pittman Motors

The positive end and negative end of the Pittman motor were connected to pin 6 and pin 3 of the H-bridge, respectively. Encoder A of the Pittman motor was connected to pin 6 of the slave PICs, while encoder B was connected to pin 5.

Schematic

Robot Drummer Schematic


Programming

Programming Overview

Three sets of code were required for our project: the MATLAB code, C code for the master PIC, and C code for the slave PICs. The MATLAB code sends commands to the master PIC. The master PIC code read all the serial communication from MATLAB and converted it into appropriate I2C commands for the slave PICs, which were completely dedicated to motor control and encoding.

Matlab

Robot_Drummer_Matlab.zip

This zip file contains all the Matlab functions needed, as well as two sample code files.

Matlab CommandPurposeFormatExampleExample's Outcome
MotorControllerConnect.mEnables communication between Matlab and the master PICserial object = MotorControllerConnect(serial port number)s = MotorControllerConnect(6)Will connect the master and Matlab through COM port 6
mc_reset_pos.mResets the current position to zeromc_reset_pos(device,serial object)mc_reset_pos(0,s)Will reset slave #0 motor's current position to zero
set_mc_position.mSets the desired positionset_mc_position(position,device,serial object)set_mc_position(5000,0,s)Will set slave #0 motor's current position to 5000
mc_get_position.mGets the current positionposition = mc_get_position(device,serial object)position = mc_get_position(0,s)Will get slave #0 motor's current position

Master

Robot_Drummer_Master.c
Robot_Drummer_MotorControllerFunctions.c

There are two files related to the master PIC. Robot_Drummer_Master.c is the file that needs to be put on the master PIC. Robot_Drummer_MotorConntrollerFunctions.c should be put in the same directory as Robot_Drummer_Master.c.

If the master PIC senses data being pushed to serial buffer, it reads the incoming data. The appropriate function in Robot_Drummer_MotorController.c is called, which sends a command to a slave. If data was requested, the master writes it back to Matlab.

Master PIC C CommandPurposeExampleExample's Outcome
set_mc_position(device,number)Sets the desired position of the motorset_mc_position(0x80,5000)Will set slave #0 motor's position to 5000
mc_get_position(device)Gets the position of the motorposition = mc_get_position(0x80)Will get slave #0 motor's current position
mc_resetpos(device)Sets the current position of the motor to zeromc_resetpos(0x80)Will sett slave #0 motor's current position to zero
mc_pos(device)Sets slave to position trackingmc_pos(0x80)Will put slave #0 in position tracking mode
mc_go()Begins actions on all slave. Note that mc_go() must be sent before the action is carried outmc_go()Will tell slave to run previous commands

Slave

There is one file related to each slave PIC.

Slave Addressing

The following table shows the 16 preset addresses. The device numbers are used in the Matlab commands, while the Hex I2C addresses need to be defined in the top of the slave code.

Device NumberHex I2C Address
080
182
284
386
488
58A
68C
78E
890
992
1094
1196
1298
139A
149C
159E

Relflections

Objectives Met

Overall, we are pleased with the progress we've made in the relatively short amount of time. We believe this project will be of great use to others. We were able to meet the following objectives:

  • Make it easy for anyone to do high-speed encoder-based feedback control of brushed DC motors cheaply.
  • The master PIC is consistently able to receive commands from Matlab using the RS232 cable.
  • The master PIC is consistently able to communicate the commands back to the slave PICs using I2C.
  • Learn about and take advantage of the 18F4431's built-in quad encoder.
  • The slave PICs implement PID control.
  • Upon request, data can be sent from the slave PICs back to Matlab.

Problems Encountered

At first, we encountered a lot of trouble with the RS232 communication, the I2C communication and motor control. We spent a lot of time inefficiently, but eventually developed a plan that helped us solve our problems. For those trying to recreate this project, it may be useful to build each component separately and then combine them. We found the debugging strategy below to be useful.

Debuggging Strategy

Test RS232

In order to test the RS232, connect the RS232 cable to the appropiate pins of the master PIC (see Electrical Design). To see that the master PIC can receive data from the RS232, send a desired position from Matlab and turn on some LEDs or output the position on the d register in the master PIC code.

In master PIC's Robot_Drummer_MotorControllerFunctions.c:

void set_mc_pos(int device,  int32 position)
{
   int* output[5] = {0,0,0,0,0};
   int ii;
   output_d(position);
   output[0] = 2;
   for(ii=0;ii<2;ii++)
   {
      output[ii+1] = (int8)(position>>(8*(ii)));
   }
   mc_transmit(device,output);
}

Test I2C

In the master PIC code, instead of waiting to receive commands from Matlab, you can send directly send commands from the master PIC to a slave PIC. For example, the following code can be used in the main loop to send a desired position:

set_mc_pos(0x80,5000);
mc_go();

It may also be useful to turn on LEDs to see that the master is transmitting data and/or the slave is receiving data.

Test Motor Control

In the slave code, instead of waiting to receive commands from the master, manually set the target position in the main loop. This way, you can see if the motor control is working.

Other Problems

  • The L293D H-bridge heated up and eventually burnt out a couple of times during testing.
  • Occasionally, the drum sticks tried to reach their position by making a complete 360, but this was not possible due to the drum. This would cause internal problems in the motor.
  • The drum sticks would sometime fall from its position due to gravity.

Future Work

There are many options that could be researched and developed to make this project better.

  • Due to time constraints, we were not able to implement the flash memory. Flash memory is a more reliable method of data logging than currently implemented.
  • In addition to the position control that is available, velocity control would be useful.

See Also