'################################################# ##
'servoboard_sd21_test1.bas
'für
'RoboterNetz Board RN-Control (ab Version 1.1)
'und das Servoboard SD21 (steuert bis zu 21 Servos)
'
'Infos, Beispielprogramme und Bezugsquelle: www.Robotikhardware.de
'Diskussionsforum: www.roboternetz.de
'Wiki: www.rn-wisssen.de
'Aufgabe:
'Servo 1 wird einige male schnell hin und her bewegt
'danach das gleiche mit Servo 2 und danach beide
'Danach wird das gleiche Spiel nochmal mit langsamer Drehung durchgeführt
'Autor: Frank Roboternetz.de / Robotikhardware.de
'################################################# ######
$programmer = 13 '1=LPT stk200 13=MCS Bootloader

Const Sd21_slaveid = &HC2
Declare Function Sd21_version() As Byte

$regfile = "m32def.dat"
$framesize = 42
$swstack = 42
$hwstack = 42
$crystal = 16000000 'Quarzfrequenz
$baud = 9600


Dim W As Word
Dim Volt As Single
Const Ref = 5 / 1023
Config Adc = Single , Prescaler = Auto
Start Adc
Porta.2 = 0

Do

W = Getadc(
Volt = W * Ref
Volt = Volt * 5.2941
If Volt > 3 , 6 Then 'hab noch keine genaue spannung die überschritten werden soll
Sound Portd.7 , 400 , 450 'BEEP
Sound Portd.7 , 400 , 250 'BEEP
Sound Portd.7 , 400 , 450 'BEEP
End If
Loop

ist das Programm, die Servos sollen dann eig anstatt des piepsen sich bewegen. Die Servos sind an dem sd21 angeschlossen. Was den Schaltplan angeht hab ich keinen. sd21 is über I2C Bus verbunden mit dem µC. Sensor ist an masse und +5V verbunden. Sonst alles nach Anleitung.