For my master's thesis I need a handyboard to control both a small robotic experiment and a computer that records data. There are many small glitches that I have run into and I will be posting them here so other users of the handyboard can use what I have learned.
I have written a small library to query the status of the motors and it can be downloaded below.
On/Off and Direction
There are many built in functions in interactive c to set the motor speed and direction; however, once it has been set there is no built in functionality to query the status of the motors. It is a relatively easy process to get the status by looking at the motor controller status byte 0x0e.
The status byte (8 bits) uses the top 4 bits to turn the motors on and off and the bottom 4 bits to set direction. So by looking at the byte: poke( 0x0e ) we can see what motors are set and which direction they are turning. By some simple bit shifting and masking you can easily determine the state of any given motor.
The following function is available in my library but is also put here for easy viewing.
* get_motor_status( int motor )
*
* DESCRIPTION
* Queries the motor controller and returns the
* status of the motor in question
*
* PARAMETERS
* motor - The number of the motor port (0-3)
* that you want to find the status
* of
*
* RETURNS
* 1 - Motor is on and going forward
* 0 - Motor is off
* -1 - Motor is on and going backwards
*
*/
int get_motor_status( int motor ) {
/* Check to see if the motor is off */
if( ((peek( 0x0e ) >> (4 + motor)) & 0x1) == 0 )
return 0;
/* Determine motor dircetion */
if( ((peek( 0x0e ) >> motor) & 0x1) == 1 )
return -1;
else
return 1;
} /* get_motor_status() */
Getting Motor Speed
Getting the motor speed requires using the data that controlles the Pulse Width Modulation (PWM) algorithms on the Handyboard. The speeds for motors 0 - 3 are, respectively, 0x22, 0x23, 0x24 and 0x25. By grabbing the value stored at that memory location you can get the speed the motor is set to.
The built in functions let you control the speed using a range of 0 - 100 (in both forward and backward directions) but a stock Handyboard only gives 7 graduations of control. The 7 speeds are denoted by the 7 following bit patterns:
- 0b00000000
- 0b00010001
- 0b01001001
- 0b01010101
- 0b01010111
- 0b01110111
- 0b01111111
- 0b11111111
The following code returns the value of the byte at the address for the motors speed:
/*************************************
* get_motor_speed( int motor )
*
* DESCRIPTION
* Returns the speed of 'motor'
*
* PARAMTERS
* motor - The number of the motor port (0-3)
* that you want to find the status
* of
*
* RETURNS
* The speed of the given motor as a value
* between 0 and 255.
*
* ADDITIONAL NOTES
* The Handyboard by default has only 7 graduations
* of power control even though you can set the
* speed with a range 0 to 100. The 7 speeds are
* represented by the following bit patterns.
*
* 0b00000000
* 0b00010001
* 0b01001001
* 0b01010101
* 0b01010111
* 0b01110111
* 0b01111111
* 0b11111111
*
*/
int get_motor_speed( int motor ) {
return peek( 0x22 + motor );
} /* get_motor_speed() */These two functions make up the library that I wrote for querying the motor controller. Feel free to use it, abuse it and give it to your friends.
Cheers,
Vince
| Attachment | Size |
|---|---|
| motor_ext.c | 3.29 KB |
[url=http://www.tibiacrystal.com]tibia money[/url] [url=http://www.tibiacrystal.com]tibia gold[/url] [url=http://www.tibiacrystal.com]tibia item[/url] [url=http://www.rsgold-accounts.com/accounts.htm]runescape accounts[/url] [url=http://www.rsgold-accounts.com/accounts.htm]buy runescape accounts[/url] [url=http://www.rsgold-accounts.com/index-1.htm]runescape money[/url] [url=http://www.rsgold-accounts.com/index-1.htm]runescape gold[/url] [url=http://www.rsgold-accounts.com/index-1.htm]runescape gp[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]runescape power leveling[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]runescape powerleveling[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]cheap rs2 powerleveling [/url] [url=http://www.rsgold-accounts.com/equipments.htm]runescape equipment[/url] [url=http://www.rsgold-accounts.com/equipments.htm]buy rs equipment[/url] [url=http://www.rsgold-accounts.com/runes.htm]runescape runes[/url] [url=http://www.rsgold-accounts.com/runes.htm]cheap rs2 runes[/url] [url=http://www.rsgold-accounts.com/logs.htm]runescape logs[/url] [url=http://www.rsgold-accounts.com/logs.htm]cheap rs2 logs[/url] [url=http://www.rsgold-accounts.com/othergoods.htm]runescape items[/url] [url=http://www.rsgold-accounts.com/othergoods.htm]buy runescape items[/url] [url=http://www.rsgold-accounts.com/questpoint.htm]runescape quest point[/url] [url=http://www.rsgold-accounts.com/questpoint.htm]rs2 quest point[/url] [url=http://www.rsgold-accounts.com/questpoint.htm]cheap runescape questpoint[/url] [url=http://www.rsgold-accounts.com/FAQ.htm]runescape gold[/url] [url=http://www.rsgold-accounts.com/FAQ.htm]runescape items[/url] [url=http://www.rsgold-accounts.com/FAQ.htm]runescape power leveling[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape money[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape gold[/url] [url=http://www.cgoldseller.com/rs1.asp]buy runescape gold[/url] [url=http://www.cgoldseller.com/rs1.asp]buy runescape money[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape items[/url] [url=http://www.cgoldseller.com/rs01.asp]runescape accounts[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape gp[/url] [url=http://www.rsgold-accounts.com/FAQ.htm]runescape accounts[/url] [url=http://www.rsgold-accounts.com/FAQ.htm]runescape money[/url] [url=http://www.cgoldseller.com/RunescapePowerleveling.asp]runescape power leveling[/url] [url=http://www.cgoldseller.com/RunescapePowerleveling.asp]runescape powerleveling[/url] [url=http://www.cgoldseller.com/serverlist1.asp?gid=18&gname=Tibia]tibia gold[/url] [url=http://www.cgoldseller.com/serverlist2.asp?gid=19&gname=Dofus]dofus kamas[/url] [url=http://www.cgoldseller.com/serverlist2.asp?gid=19&gname=Dofus]buy dofus kamas[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]wow power leveling[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]wow powerleveling[/url] [url=http://www.rsgold-accounts.com/questpoint.htm]runescape questpoint[/url] [url=http://www.rsgold-accounts.com/questpoint.htm]rs2 questpoint[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]Warcraft PowerLeveling[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]Warcraft Power Leveling[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]World of Warcraft PowerLeveling[/url] [url=http://www.cgoldseller.com/serverlist5.asp?gid=23&gname=World%20of%20Warcraft%20-%20USA]World of Warcraft Power Leveling[/url] [url=http://www.cgoldseller.com/serverlist6.asp?gid=24&gname=Hellgate%20London]Hellgate money[/url] [url=http://www.cgoldseller.com/serverlist6.asp?gid=24&gname=Hellgate%20London]Hellgate gold[/url] [url=http://www.rsgold-accounts.com/logs.htm]buy runescape logs[/url] [url=http://www.rsgold-accounts.com/othergoods.htm]buy rs2 items[/url] [url=http://www.rsgold-accounts.com/othergoods.htm]cheap runescape items[/url] [url=http://www.cgoldseller.com/serverlist6.asp?gid=24&gname=Hellgate%20London]Hellgate London gold[/url] [url=http://www.cgoldseller.com/serverlist14.asp?gid=32&gname=Guild%20Wars]Guild Wars Gold[/url] [url=http://www.cgoldseller.com/serverlist14.asp?gid=32&gname=Guild%20Wars]buy Guild Wars Gold[/url] [url=http://www.rsgold-accounts.com/accounts.htm]runescape items[/url] [url=http://www.rsgold-accounts.com/accounts.htm]rs2 accounts[/url] [url=http://www.rsgold-accounts.com/equipments.htm]cheap rs2 equipments[/url] [url=http://www.cgoldseller.com/serverlist8.asp?gid=26&gname=Lord%20of%20the%20Rings%20Online(US)]lotro gold[/url] [url=http://www.cgoldseller.com/serverlist8.asp?gid=26&gname=Lord%20of%20the%20Rings%20Online(US)]buy lotro gold[/url] [url=http://www.rsgold-accounts.com/index-1.htm]buy runescape money[/url] [url=http://www.rsgold-accounts.com/index-1.htm]buy runescape gold[/url] [url=http://www.rsgold-accounts.com/runes.htm]buy runescape runes[/url] [url=http://www.cgoldseller.com/serverlist7.asp?gid=25&gname=Lord%20of%20the%20Rings%20Online(EU)]lotro gold[/url] [url=http://www.cgoldseller.com/serverlist7.asp?gid=25&gname=Lord%20of%20the%20Rings%20Online(EU)]buy lotro gold[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape money[/url] [url=http://www.cgoldseller.com/rs1.asp]runescape gold[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]cheap rs2 powerleveling [/url] [url=http://www.cgoldseller.com/serverlist11.asp?gid=29&gname=EVE%20online]eve isk[/url] [url=http://www.cgoldseller.com/serverlist11.asp?gid=29&gname=EVE%20online]eve online isk[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]buy runescape power leveling[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]rs2 power leveling[/url] [url=http://www.tibiacrystal.com]tibia gold[/url] [url=http://www.tibiacrystal.com]tibia item[/url] [url=http://www.cgoldseller.com/rs01.asp]runescape accounts[/url] [url=http://www.cgoldseller.com/serverlist10.asp?gid=28&gname=Fiesta]Fiesta Silver[/url] [url=http://www.cgoldseller.com/serverlist10.asp?gid=28&gname=Fiesta]Fiesta Gold[/url] [url=http://www.cgoldseller.com/serverlist13.asp?gid=31&gname=SilkRoad%20Online]SilkRoad Gold[/url] [url=http://www.cgoldseller.com/serverlist13.asp?gid=31&gname=SilkRoad%20Online]buy SilkRoad Gold[/url] [url=http://www.cgoldseller.com/serverlist3.asp?gid=20&gname=Scions%20of%20Fate]Scions of Fate Gold[/url] [url=http://www.cgoldseller.com/serverlist6.asp?gid=24&gname=Hellgate%20London]Hellgate Palladium[/url] [url=http://www.cgoldseller.com/serverlist6.asp?gid=24&gname=Hellgate%20London]Hellgate London Palladium[/url] [url=http://www.cgoldseller.com/serverlist3.asp?gid=20&gname=Scions%20of%20Fate]SOF Gold[/url] [url=http://www.cgoldseller.com/serverlist4.asp?gid=22&gname=Age%20Of%20Conan]Age Of Conan Gold[/url] [url=http://www.cgoldseller.com/serverlist4.asp?gid=22&gname=Age%20Of%20Conan]AOC Gold[/url] [url=http://www.cgoldseller.com/serverlist12.asp?gid=30&gname=ArchLord]ArchLord gold[/url] [url=http://www.tibiacrystal.com]tibia money[/url] [url=http://www.tibiacrystal.com]tibia gold[/url] [url=http://www.rsgold-accounts.com/accounts.htm]runescape accounts[/url] [url=http://www.rsgold-accounts.com/index-1.htm]runescape gold[/url] [url=http://www.rsgold-accounts.com/powerleveling.htm]cheap rs2 powerleveling [/url] [url=http://www.cgoldseller.com/serverlist12.asp?gid=30&gname=ArchLord]buy ArchLord gold[/url] [url=http://www.cgoldseller.com/serverlist9.asp?gid=27&gname=Dungeons%20&%20Dragons%20Online]DDO Plat[/url] [url=http://www.cgoldseller.com/serverlist9.asp?gid=27&gname=Dungeons%20&%20Dragons%20Online]Dungeons and Dragons Online Plat[/url]
Post new comment