PBP IF,THEN help

[paulcox82]

I will modify the AND condition statements and include a 100ms pause between motor movemnts.

Thanks for the help.

[paulcox82]

I removed the "AND" functions and replaced them with direct port readings and added 100ms delays between motor commands. I have also added a command to set the inputs to digital. The problem still persists, though my memory usage has greatly reduced.

Anybody have any other ideas that may work to resolve this issue?

It may be the hysterisis of the potentiometer, but I am scratching my head on how to eliminate this in code as each comparator is set high.

Thanks for the help,
Paul Cox

here is my updated code:

TRISA=%11111000 'make A0, A1 & A2 outputs
TRISB=%11101111 'make B0, B1, B2, B3, B5, B6 & B7 inputs

CCWDRV var PortA.0 'change port name
CWDRV var PortA.1 'change port name
LED var PortA.2 'change port name
CNTR var PortB.0 'change port name
PT1 var PortB.7 'change port name
PT2 var PortB.6 'change port name
PT3 var PortB.5 'change port name
PT4 var PortB.3 'change port name
PT5 var PortB.2 'change port name
PT6 var PortB.1 'change port name

CMCON = 7

cycle:

if PortB=%00000000 then '000 000 right stop
low LED
pause 50
high LED
pause 500
low LED
pause 500
goto cycle
endif

if PortB=%11101110 then '111 111 left stop
low LED
pause 50
high LED
pause 500
low LED
pause 500
goto cycle
endif

if PortB=%00000001 then '000 000 center from right stop
low LED
pause 50
high CCWDRV
pause 500
gosub CCWCENTER 'go to sub-routine to center from right
goto cycle
endif

if PortB=%11101111 then '111 111 center from left stop
low LED
pause 50
high CWDRV
pause 500
gosub CWCENTER 'go to sub-routine to center from left
goto cycle
endif

if PortB=%00000011 then '100 000
low LED
pause 50
high CCWDRV
pause 500
gosub CCWCENTER 'go to sub-routine to center from right
goto cycle
endif

if PortB=%00000111 then '110 000
low LED
pause 50
high CCWDRV
pause 500
gosub CCWCENTER 'go to sub-routine to center from right
goto cycle
endif

if PortB=%00101111 then '111 100
low LED
pause 50
high CWDRV
pause 500
gosub CWCENTER 'go to sub-routine to center from left
goto cycle
endif

if PortB=%01101111 then '111 110
low LED
pause 50
high CWDRV
pause 500
gosub CWCENTER 'go to sub-routine to center from left
goto cycle
endif

GOTO cycle

CCWCENTER
if PortB=%00001111 then
low CCWDRV 'stop motor at 111000 position
pause 1000 'change to 250ms after debugging
high CCWDRV 'start motor for last leg of travel
pause 2000 'run time to go from 15 degrees to center CCW
low CCWDRV
endif
return

CWCENTER
if PortB=%00001111 then
low CWDRV 'stop motor at 111000 position
pause 1000 'change to 250ms after debugging
high CWDRV 'start motor for last leg of travel
pause 2000 'run time to go from 15 degrees to center CW
low CWDRV
endif
return

end

[mikendee]

Don't know if it's just a typo, but the sub-routine labels need colons.

CCWCENTER:
CWCENTER:

I don't think they work otherwise

Mike

[Dave]

paulcox82, Is there any dynamic braking on the motor drive circuits? How big is the motor and is there any gearing involved? Where is the pot in relationship to the motor(ie, any gears in between?) I dont beleive 100 milliseconds is enough to stop the motor especially if there is no dynamic braking of the motor itself.. How long does it take for the motor to come to a complete stop after commanding to shut off? This time should be the minimum time for the "off delay" and the travel in degrees should be the minimum for the comparators sensing position... Could you please supply a circuit diagram to better understand the drive?

Dave Purola,
N8NTA

[paulcox82]

Mike,

The missing colons were a typo. Thank you. I added them, but still have the same issue.

Dave,

The motor is a small piezo driven motor that will eventually move through some gearing, but very slowly. On the order of 2 RPM. I am simulating the motor position potentiometer by moving an external pot by hand. I will increase the wait periods between motor movements and let you know the results.

Thanks for the help.
Paul

[paulcox82]

As requested, here is the schematic for the motor controller section.

-Paul

[comwarrior]

I can't help but think your solution is overly complecated...

if i got you right you've got POT's setup (6 i believe?) to measure some sort of angles ( ) and feed these into a comparator which i'm assuming has some sort of reference pot so that you can tune it to the angle you want.
Your then reading the output from your comparators from your pic and controlling a set of motors...

Far too complecated...

if i may, can i surgest a more acurite way...

Something like a pic16F877A has 8 analogue ports that can read a POT directly...
So, use 10K or 100K pots, connect one end of pot to +5V the other to ground and the middle pin goes to your ADC port (acts as a voltage devider)...
In the program you read the ADC, if it's anything other than 2.5volts (50% of the ADC max value) then it's off center and you can take action directly with the pic...
You will find this method much more precise as it will measure less than 1 deg off center...

Also, if you are measuring say pitch and roll, you therefor only need two pots and 4 outputs (2 per motor)...

I'f i've got what your trying to do completely wrong then tell me...

:edit
Actually, the pic your using has 4 analogue lines...