The first arm I made for my robot turned out to be a little on the small side.
Also it did not do much, as it was driven by just one motor.
So I decided to make new Arms.
To have arms do lots of different movements needs lots of motors, I want to
keep this to a minimum.
I will be using DC motors.
To control a motor properly you need feedback from the motor or whatever it is
moving.
As a minimum you need stops at its limits and some sort of position counter.
I have already made a driver for the
Pen Lifter and Platform Lifter
which only needs one control signal and has stops. With this setup the motor
always travels to the extremes. I will need to modify this driver so that I
can stop the arm motors at any position and know what that position is.
I have come up with a circuit form my new motor driver.
It will require five pins on a microprocessor controlling it, one for
forward, one for reverse, one for position feedback and two for the stops
feedback. That's quite a lot of pins for controlling a motor.
So this is going to limit the number of motors I can use if I just want to use
a Nano to control all arm motors. I am going to use the AtMega168, I don't
need to much memory (well I will find out).
To increase the number of pins the Nano has use of, I decided to add another
MCP23017, this gives me 16 more pins.
I decided I would just have six motors, three in each arm. One for the
shoulder, one for the elbow and one for the hand grip.
That's going to need 30 pins on the microprocessor. Actually it will be just
24, I am not going to have feedback from the Hand Grips at the moment.
Although the Nano has 22 GPIO pins, on the Nano I still need two for I2C, two
for TX/RX and two for getting interrupts from the MCP23017. This leaves only
16.
So I have decided to use 12 pins on the Nano to control direction of each
motor, and use 12 pins on the MCP23017 for feedback from the motors.
The MCP23017 is split into 2 ports, so I am going to use one port for the left
side and the other port for the right side. This way the two interrupts will
be one for left and one for right.
I am going to put all six motor drivers on one PCB, I am also going to have a
go with SMD's (Surface Mounted Devices).
So with this in mind, I have decided to have the BCP made by a professional
manufacturer.
The PCB Manufacture I chose was
PCBWay, this is the
first time I have had a PCD made by a manufacturer of PCB's so I am going to
do a separate post on how I designed the board and got it manufactured.
The result looks like this:
With components and Fitted:
Now all I have to do is figure out how I am goring to fit the stops and
counter to the motors.
In the past I have use an infrared sensor and shutter system to count
movements like I have for the riser on the chassis.
The size of these makes it very impractical, I have seen smaller versions, I
have some I salvaged from old printers.
Then I remembered about the 3144 hall effect sensor, it is small and magnets
come in all sizes.
I thought of the
magnetic strip, this can be cut into any size.
I did some experiments to see if was strong enough when cut into small pieces.
It worked great, I had to find its polarity and mark it up before cutting so
that I placed them in there correct orientation.
For the shoulder motor I glued the magnets into a holder I made, so that it
could be fitted to the top of the shoulder.
I made a small circuit board for the sensor which could be mounted to the
frame.
As the arm rotates about the shoulder the magnets pass in front of the
sensor, switching it on and off.
This enables the microcontroller count it's position.
Next was to add stops so that the motor would not go beyond it's limits and
the controller would know when to start counting from.
I was able to modify the shoulder mount to hold two switches and I made two
adjustable stops that fitted around the shoulder joint.
The motor for the forearm was a little easier.
I used a hall effect sensor again, but this time I cut a piece of
magnetic strip
into a disc, which I was able to placed on the drive shaft.
This gave me a lot more accuracy, as the disc rotated one revolution, it
turned the sensor on and off three times, the sensor had to be in just the
right position, if it was out of position it only turned on and off, once
every rotation.
The switches where mounted as I had done for the
platform lifter.
For the hand I have just fitted stops for open and close.
The close switch detects when something has been griped.
If you like what I have done, or want to know more.
Please leave a comment below.
No comments:
Post a Comment