Compare commits
No commits in common. "aa1ce997cd45172782e5c540d1a36a45eaa08ee7" and "bf17e4b02eb9060159adb5676cb446bb62b272c7" have entirely different histories.
aa1ce997cd
...
bf17e4b02e
3 changed files with 2 additions and 226 deletions
|
@ -7,7 +7,7 @@ void setup() {
|
||||||
servo1.attach(9);
|
servo1.attach(9);
|
||||||
servo2.attach(10);
|
servo2.attach(10);
|
||||||
Serial.begin(9600);
|
Serial.begin(9600);
|
||||||
Serial.println("format : [0-180][ab]");
|
Serial.print("format : [0-180][ab]");
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop() {
|
void loop() {
|
||||||
|
@ -21,14 +21,10 @@ void loop() {
|
||||||
v = v * 10 + ch - '0';
|
v = v * 10 + ch - '0';
|
||||||
break;
|
break;
|
||||||
case 'a':
|
case 'a':
|
||||||
Serial.print("Servo(9) :");
|
|
||||||
Serial.println(v);
|
|
||||||
servo1.write(v);
|
servo1.write(v);
|
||||||
v = 0;
|
v = 0;
|
||||||
break;
|
break;
|
||||||
case 'b':
|
case 'b':
|
||||||
Serial.print("Servo(10):");
|
|
||||||
Serial.println(v);
|
|
||||||
servo2.write(v);
|
servo2.write(v);
|
||||||
v = 0;
|
v = 0;
|
||||||
break;
|
break;
|
||||||
|
|
|
@ -1,123 +0,0 @@
|
||||||
#include <Servo.h>
|
|
||||||
|
|
||||||
// Servo : SC-1267SG
|
|
||||||
unsigned int steeringServoCenter = 1820; //us
|
|
||||||
unsigned int steeringServoMin = (steeringServoCenter-780); //us
|
|
||||||
unsigned int steeringServoMax = (steeringServoCenter+780); //us
|
|
||||||
|
|
||||||
// Servo : SC-0352
|
|
||||||
unsigned int lanceServoCenter = 1560; //us
|
|
||||||
unsigned int lanceServoMin = (lanceServoCenter-780); //us
|
|
||||||
unsigned int lanceServoMax = (lanceServoCenter+780); //us
|
|
||||||
|
|
||||||
unsigned char rotPin = 2;
|
|
||||||
|
|
||||||
unsigned char numSensors = 8;
|
|
||||||
unsigned char sensorPin[] = {19,18,17,16,15,14,13,12}; //右端から順番に左端へ
|
|
||||||
|
|
||||||
unsigned char steeringServoPin = 9;
|
|
||||||
unsigned char lanceServoPin = 10;
|
|
||||||
|
|
||||||
volatile unsigned long distance = 0;
|
|
||||||
|
|
||||||
Servo lanceServo;
|
|
||||||
Servo steeringServo;
|
|
||||||
|
|
||||||
/* ステアリングを中央からa[度]だけ動かす
|
|
||||||
<- - 0 + ->
|
|
||||||
||
|
|
||||||
||
|
|
||||||
[]---{}---[]
|
|
||||||
/ .\
|
|
||||||
*/
|
|
||||||
int steering(int a){
|
|
||||||
steeringServo.write(90 + a);
|
|
||||||
return (steeringServo.read() - 90);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* ランスを中央からa[度]だけ動かす
|
|
||||||
<- - 0 + ->
|
|
||||||
/ .\
|
|
||||||
/ | \
|
|
||||||
[]+--{}--+[]
|
|
||||||
*/
|
|
||||||
int lance(int a){
|
|
||||||
lanceServo.write(90 - a);
|
|
||||||
return (90 - a);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* センサーのアレイの初期化 */
|
|
||||||
void sensorInit(){
|
|
||||||
for(int i=0; i<numSensors; i++){
|
|
||||||
pinMode(sensorPin[i], INPUT);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* エンコーダーの割り込み処理 */
|
|
||||||
void rot(){
|
|
||||||
distance++;
|
|
||||||
}
|
|
||||||
|
|
||||||
void setup() {
|
|
||||||
steeringServo.attach(steeringServoPin, steeringServoMin, steeringServoMax);
|
|
||||||
lanceServo.attach(lanceServoPin, lanceServoMin, lanceServoMax);
|
|
||||||
steering(0);
|
|
||||||
lance(0);
|
|
||||||
pinMode(rotPin, INPUT);
|
|
||||||
attachInterrupt(0, rot, RISING);
|
|
||||||
Serial.begin(9600);
|
|
||||||
Serial.println("format : [+-][0-180][hl]");
|
|
||||||
}
|
|
||||||
|
|
||||||
void loop() {
|
|
||||||
static int i = 0;
|
|
||||||
i++;
|
|
||||||
if(i>100){
|
|
||||||
i = 0;
|
|
||||||
Serial.print(distance);
|
|
||||||
Serial.print('\t');
|
|
||||||
for(int i=0; i<numSensors; i++){
|
|
||||||
Serial.print(digitalRead(sensorPin[i]));
|
|
||||||
}
|
|
||||||
Serial.println();
|
|
||||||
}
|
|
||||||
|
|
||||||
static int v = 0;
|
|
||||||
static int s = 1;
|
|
||||||
|
|
||||||
if ( Serial.available() ) {
|
|
||||||
char ch = Serial.read();
|
|
||||||
switch(ch) {
|
|
||||||
case '-':
|
|
||||||
s = -1;
|
|
||||||
break;
|
|
||||||
case '0'...'9':
|
|
||||||
v = v * 10 + ch - '0';
|
|
||||||
break;
|
|
||||||
case 'l':
|
|
||||||
v = s*v;
|
|
||||||
Serial.print("lance :");
|
|
||||||
Serial.println(v);
|
|
||||||
lance(v);
|
|
||||||
v = 0;
|
|
||||||
s = 1;
|
|
||||||
break;
|
|
||||||
case 'h':
|
|
||||||
v = s*v;
|
|
||||||
Serial.print("steering :");
|
|
||||||
Serial.println(v);
|
|
||||||
steering(v);
|
|
||||||
v = 0;
|
|
||||||
s = 1;
|
|
||||||
break;
|
|
||||||
case 'c':
|
|
||||||
Serial.println("clear");
|
|
||||||
distance = 0;
|
|
||||||
v = 0;
|
|
||||||
s = 1;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
delay(1);
|
|
||||||
}
|
|
|
@ -3,7 +3,7 @@
|
||||||
#fi
|
#fi
|
||||||
#export LANG
|
#export LANG
|
||||||
|
|
||||||
PATH="~/Documents/bin:$PATH"
|
PATH="~/bin:$PATH"
|
||||||
|
|
||||||
PS1='\[\e[1;32m\]\D{%F %T}\[\e[0m\] \[\e[1;34m\]\w\[\e[0;1m\]
|
PS1='\[\e[1;32m\]\D{%F %T}\[\e[0m\] \[\e[1;34m\]\w\[\e[0;1m\]
|
||||||
\$ \[\e[0m\]'
|
\$ \[\e[0m\]'
|
||||||
|
@ -34,109 +34,12 @@ complete -c man sudo
|
||||||
|
|
||||||
set -o noclobber
|
set -o noclobber
|
||||||
|
|
||||||
alias base64=gbase64
|
|
||||||
alias basename=gbasename
|
|
||||||
alias cat=gcat
|
|
||||||
alias chgrp=gchgrp
|
|
||||||
alias chmod=gchmod
|
|
||||||
alias chown=gchown
|
|
||||||
alias chroot=gchroot
|
|
||||||
alias cksum=gcksum
|
|
||||||
alias comm=gcomm
|
|
||||||
alias cp=gcp
|
|
||||||
alias csplit=gcsplit
|
|
||||||
alias cut=gcut
|
|
||||||
alias date=gdate
|
|
||||||
alias dd=gdd
|
|
||||||
alias df=gdf
|
|
||||||
alias dir=gdir
|
|
||||||
alias dircolors=gdircolors
|
|
||||||
alias dirname=gdirname
|
|
||||||
alias du=gdu
|
|
||||||
alias echo=gecho
|
|
||||||
alias env=genv
|
|
||||||
alias expand=gexpand
|
|
||||||
alias expr=gexpr
|
|
||||||
alias factor=gfactor
|
|
||||||
alias false=gfalse
|
|
||||||
alias fmt=gfmt
|
|
||||||
alias fold=gfold
|
|
||||||
alias groups=ggroups
|
|
||||||
alias head=ghead
|
|
||||||
alias hostid=ghostid
|
|
||||||
alias hostname=ghostname
|
|
||||||
alias id=gid
|
|
||||||
alias install=ginstall
|
|
||||||
alias join=gjoin
|
|
||||||
alias kill=gkill
|
|
||||||
alias link=glink
|
|
||||||
alias ln=gln
|
|
||||||
alias logname=glogname
|
|
||||||
alias ls='gls -F'
|
|
||||||
alias md5sum=gmd5sum
|
|
||||||
alias mkdir=gmkdir
|
|
||||||
alias mkfifo=gmkfifo
|
|
||||||
alias mknod=gmknod
|
|
||||||
alias mv=gmv
|
|
||||||
alias nice=gnice
|
|
||||||
alias nl=gnl
|
|
||||||
alias nohup=gnohup
|
|
||||||
alias od=god
|
|
||||||
alias paste=gpaste
|
|
||||||
alias pathchk=gpathchk
|
|
||||||
alias pinky=gpinky
|
|
||||||
alias pr=gpr
|
|
||||||
alias printenv=gprintenv
|
|
||||||
alias printf=gprintf
|
|
||||||
alias ptx=gptx
|
|
||||||
alias pwd=gpwd
|
|
||||||
alias readlink=greadlink
|
|
||||||
alias rm=grm
|
|
||||||
alias rmdir=grmdir
|
|
||||||
alias seq=gseq
|
|
||||||
alias sha1sum=gsha1sum
|
|
||||||
alias sha224sum=gsha224sum
|
|
||||||
alias sha256sum=gsha256sum
|
|
||||||
alias sha384sum=gsha384sum
|
|
||||||
alias sha512sum=gsha512sum
|
|
||||||
alias shred=gshred
|
|
||||||
alias shuf=gshuf
|
|
||||||
alias sleep=gsleep
|
|
||||||
alias sort=gsort
|
|
||||||
alias split=gsplit
|
|
||||||
alias stat=gstat
|
|
||||||
alias stty=gstty
|
|
||||||
alias su=gsu
|
|
||||||
alias sum=gsum
|
|
||||||
alias sync=gsync
|
|
||||||
alias tac=gtac
|
|
||||||
alias tail=gtail
|
|
||||||
alias tee=gtee
|
|
||||||
alias test=gtest
|
|
||||||
alias touch=gtouch
|
|
||||||
alias tr=gtr
|
|
||||||
alias true=gtrue
|
|
||||||
alias tsort=gtsort
|
|
||||||
alias tty=gtty
|
|
||||||
alias uname=guname
|
|
||||||
alias unexpand=gunexpand
|
|
||||||
alias uniq=guniq
|
|
||||||
alias unlink=gunlink
|
|
||||||
alias uptime=guptime
|
|
||||||
alias users=gusers
|
|
||||||
alias vdir=gvdir
|
|
||||||
alias wc=gwc
|
|
||||||
alias who=gwho
|
|
||||||
alias whoami=gwhoami
|
|
||||||
alias yes=gyes
|
|
||||||
|
|
||||||
alias ls='ls -G'
|
alias ls='ls -G'
|
||||||
alias l='ls -alh'
|
alias l='ls -alh'
|
||||||
alias cp='cp -iv'
|
alias cp='cp -iv'
|
||||||
alias mv='mv -iv'
|
alias mv='mv -iv'
|
||||||
alias ln='ln -iv'
|
alias ln='ln -iv'
|
||||||
alias rm='rm -iv'
|
alias rm='rm -iv'
|
||||||
alias mkdir='mkdir -v'
|
|
||||||
alias grep='grep --color'
|
alias grep='grep --color'
|
||||||
alias egrep='egrep --color'
|
alias egrep='egrep --color'
|
||||||
alias bc='bc -l'
|
alias bc='bc -l'
|
||||||
|
|
Loading…
Add table
Reference in a new issue