Fork of LaOS. https://github.com/LaosLaser/Firmware

Dependencies:   mbed

Committer:
Michael J. Spencer
Date:
Sat Mar 08 17:55:59 2014 -0800
Revision:
2:609dd3a73f33
Parent:
1:f5ac63519541
Update.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Michael J. Spencer 1:f5ac63519541 1 /*
Michael J. Spencer 1:f5ac63519541 2 * global.cpp
Michael J. Spencer 1:f5ac63519541 3 * Read global configuration from file
Michael J. Spencer 1:f5ac63519541 4 *
Michael J. Spencer 1:f5ac63519541 5 * Copyright (c) 2011 Peter Brier
Michael J. Spencer 1:f5ac63519541 6 *
Michael J. Spencer 1:f5ac63519541 7 * This file is part of the LaOS project (see: http://wiki.protospace.nl/index.php/LaOS)
Michael J. Spencer 1:f5ac63519541 8 *
Michael J. Spencer 1:f5ac63519541 9 * LaOS is free software: you can redistribute it and/or modify
Michael J. Spencer 1:f5ac63519541 10 * it under the terms of the GNU General Public License as published by
Michael J. Spencer 1:f5ac63519541 11 * the Free Software Foundation, either version 3 of the License, or
Michael J. Spencer 1:f5ac63519541 12 * (at your option) any later version.
Michael J. Spencer 1:f5ac63519541 13 *
Michael J. Spencer 1:f5ac63519541 14 * LaOS is distributed in the hope that it will be useful,
Michael J. Spencer 1:f5ac63519541 15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
Michael J. Spencer 1:f5ac63519541 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Michael J. Spencer 1:f5ac63519541 17 * GNU General Public License for more details.
Michael J. Spencer 1:f5ac63519541 18 *
Michael J. Spencer 1:f5ac63519541 19 * You should have received a copy of the GNU General Public License
Michael J. Spencer 1:f5ac63519541 20 * along with LaOS. If not, see <http://www.gnu.org/licenses/>.
Michael J. Spencer 1:f5ac63519541 21 *
Michael J. Spencer 1:f5ac63519541 22 */
Michael J. Spencer 1:f5ac63519541 23 #include "global.h"
Michael J. Spencer 1:f5ac63519541 24 #include "ConfigFile.h"
Michael J. Spencer 1:f5ac63519541 25
Michael J. Spencer 1:f5ac63519541 26
Michael J. Spencer 1:f5ac63519541 27
Michael J. Spencer 1:f5ac63519541 28 /**
Michael J. Spencer 1:f5ac63519541 29 *** Return a IpAddress, from a string in the format: ppp.qqq.rrr.sss
Michael J. Spencer 1:f5ac63519541 30 **/
Michael J. Spencer 1:f5ac63519541 31 void IpParse(char *a, int i[])
Michael J. Spencer 1:f5ac63519541 32 {
Michael J. Spencer 1:f5ac63519541 33 int n = 0, j;
Michael J. Spencer 1:f5ac63519541 34 char c[4];
Michael J. Spencer 1:f5ac63519541 35
Michael J. Spencer 1:f5ac63519541 36 i[0] = i[1] = i[2] = i[3] =0;
Michael J. Spencer 1:f5ac63519541 37 for (n=0; n<4; n++) {
Michael J. Spencer 1:f5ac63519541 38 while (*a && (*a < '0' || *a > '9'))
Michael J. Spencer 1:f5ac63519541 39 a++;
Michael J. Spencer 1:f5ac63519541 40 j = 0;
Michael J. Spencer 1:f5ac63519541 41 while (*a && *a >= '0' && *a <= '9')
Michael J. Spencer 1:f5ac63519541 42 {
Michael J. Spencer 1:f5ac63519541 43 if ( j<3 )
Michael J. Spencer 1:f5ac63519541 44 c[j++] = *a;
Michael J. Spencer 1:f5ac63519541 45 a++;
Michael J. Spencer 1:f5ac63519541 46 }
Michael J. Spencer 1:f5ac63519541 47 c[j] = 0;
Michael J. Spencer 1:f5ac63519541 48 i[n] = atoi(c);
Michael J. Spencer 1:f5ac63519541 49 }
Michael J. Spencer 1:f5ac63519541 50 }
Michael J. Spencer 1:f5ac63519541 51
Michael J. Spencer 1:f5ac63519541 52
Michael J. Spencer 1:f5ac63519541 53 /**
Michael J. Spencer 1:f5ac63519541 54 *** Global config
Michael J. Spencer 1:f5ac63519541 55 *** Config settings into global Config struct
Michael J. Spencer 1:f5ac63519541 56 **/
Michael J. Spencer 1:f5ac63519541 57 GlobalConfig::GlobalConfig(char *filename)
Michael J. Spencer 1:f5ac63519541 58 {
Michael J. Spencer 1:f5ac63519541 59 printf("\r\nOpen config file: '%s'\r\n", filename);
Michael J. Spencer 1:f5ac63519541 60 ConfigFile cfg(filename);
Michael J. Spencer 1:f5ac63519541 61 if ( !cfg.IsOpen() )
Michael J. Spencer 1:f5ac63519541 62 {
Michael J. Spencer 1:f5ac63519541 63 printf("File does not exists. Using defaults\n");
Michael J. Spencer 1:f5ac63519541 64 }
Michael J. Spencer 1:f5ac63519541 65
Michael J. Spencer 1:f5ac63519541 66 // IP settings
Michael J. Spencer 2:609dd3a73f33 67 cfg.Value("net.ip", ip, sizeof(ip), "192.168.0.111");
Michael J. Spencer 2:609dd3a73f33 68 cfg.Value("net.mask", nm, sizeof(nm), "255.255.255.0");
Michael J. Spencer 2:609dd3a73f33 69 cfg.Value("net.gateway", gw, sizeof(gw), "192.168.0.1");
Michael J. Spencer 2:609dd3a73f33 70 cfg.Value("net.dns", dns, sizeof(dns), "192.168.0.1");
Michael J. Spencer 1:f5ac63519541 71 cfg.Value("net.port", &port, 69);
Michael J. Spencer 1:f5ac63519541 72 cfg.Value("net.dhcp", &dhcp, 0);
Michael J. Spencer 1:f5ac63519541 73
Michael J. Spencer 1:f5ac63519541 74 // features
Michael J. Spencer 1:f5ac63519541 75 cfg.Value("sys.autohome", &autohome, 0);
Michael J. Spencer 1:f5ac63519541 76 cfg.Value("sys.autozhome", &autozhome, 0);
Michael J. Spencer 1:f5ac63519541 77 cfg.Value("sys.nodisplay", &nodisplay, 1);
Michael J. Spencer 1:f5ac63519541 78 cfg.Value("sys.i2cbaud", &i2cbaud, 9600);
Michael J. Spencer 1:f5ac63519541 79 cfg.Value("sys.cleandir", &cleandir, 1);
Michael J. Spencer 1:f5ac63519541 80
Michael J. Spencer 1:f5ac63519541 81 // Laser
Michael J. Spencer 1:f5ac63519541 82 cfg.Value("laser.enable", &lenable, 1); // laser enable polarity [0/1]
Michael J. Spencer 1:f5ac63519541 83 cfg.Value("laser.on", &lon, 1); // laser on polarity [0/1]
Michael J. Spencer 1:f5ac63519541 84 cfg.Value("laser.pwm.min", &pwmmin, 0); // pwm at minimum power [0..100]
Michael J. Spencer 1:f5ac63519541 85 cfg.Value("laser.pwm.max", &pwmmax, 0); // pwm at maximum power [0..100]
Michael J. Spencer 1:f5ac63519541 86 cfg.Value("laser.pwm.freq", &pwmfreq, 20000); // pwm frequency [Hz]
Michael J. Spencer 1:f5ac63519541 87
Michael J. Spencer 1:f5ac63519541 88 // rest position (after homing)
Michael J. Spencer 1:f5ac63519541 89 cfg.Value("x.rest", &xrest, 0);
Michael J. Spencer 1:f5ac63519541 90 cfg.Value("y.rest", &yrest, 0);
Michael J. Spencer 1:f5ac63519541 91 cfg.Value("z.rest", &zrest, 0);
Michael J. Spencer 1:f5ac63519541 92 cfg.Value("e.rest", &erest, 0);
Michael J. Spencer 1:f5ac63519541 93 // (homing) direction
Michael J. Spencer 1:f5ac63519541 94 cfg.Value("x.homedir", &xhomedir, 0);
Michael J. Spencer 1:f5ac63519541 95 cfg.Value("y.homedir", &yhomedir, 0);
Michael J. Spencer 1:f5ac63519541 96 cfg.Value("z.homedir", &zhomedir, 0);
Michael J. Spencer 1:f5ac63519541 97 cfg.Value("e.homedir", &ehomedir, 0);
Michael J. Spencer 1:f5ac63519541 98
Michael J. Spencer 1:f5ac63519541 99 cfg.Value("x.invert", &xinv, 0);
Michael J. Spencer 1:f5ac63519541 100 cfg.Value("y.invert", &yinv, 0);
Michael J. Spencer 1:f5ac63519541 101 cfg.Value("z.invert", &zinv, 0);
Michael J. Spencer 1:f5ac63519541 102 cfg.Value("e.invert", &einv, 0);
Michael J. Spencer 1:f5ac63519541 103
Michael J. Spencer 1:f5ac63519541 104
Michael J. Spencer 1:f5ac63519541 105 // (homing)sensor polarity
Michael J. Spencer 1:f5ac63519541 106 cfg.Value("x.pol", &xpol, 0);
Michael J. Spencer 1:f5ac63519541 107 cfg.Value("y.pol", &ypol, 0);
Michael J. Spencer 1:f5ac63519541 108 cfg.Value("z.pol", &zpol, 0);
Michael J. Spencer 1:f5ac63519541 109 cfg.Value("e.pol", &epol, 0);
Michael J. Spencer 1:f5ac63519541 110
Michael J. Spencer 1:f5ac63519541 111 // Scaling [steps/meter]
Michael J. Spencer 1:f5ac63519541 112 cfg.Value("x.scale", &xscale, 200000);
Michael J. Spencer 1:f5ac63519541 113 cfg.Value("y.scale", &yscale, 200000);
Michael J. Spencer 1:f5ac63519541 114 cfg.Value("z.scale", &zscale, 200000);
Michael J. Spencer 1:f5ac63519541 115 cfg.Value("e.scale", &escale, 200000);
Michael J. Spencer 1:f5ac63519541 116
Michael J. Spencer 1:f5ac63519541 117 // max axis speed [mm/sec]
Michael J. Spencer 1:f5ac63519541 118 cfg.Value("x.speed", &xspeed, 100);
Michael J. Spencer 1:f5ac63519541 119 cfg.Value("y.speed", &yspeed, 100);
Michael J. Spencer 1:f5ac63519541 120 cfg.Value("z.speed", &zspeed, 100);
Michael J. Spencer 1:f5ac63519541 121 cfg.Value("e.speed", &espeed, 100);
Michael J. Spencer 1:f5ac63519541 122
Michael J. Spencer 1:f5ac63519541 123 // max axis acceleration [mm/sec2]
Michael J. Spencer 1:f5ac63519541 124 cfg.Value("x.accel", &xaccel, 2000);
Michael J. Spencer 1:f5ac63519541 125 cfg.Value("y.accel", &yaccel, 2000);
Michael J. Spencer 1:f5ac63519541 126 cfg.Value("z.accel", &zaccel, 2000);
Michael J. Spencer 1:f5ac63519541 127 cfg.Value("e.accel", &eaccel, 2000);
Michael J. Spencer 1:f5ac63519541 128
Michael J. Spencer 1:f5ac63519541 129 // max axis speed [mm/sec]
Michael J. Spencer 1:f5ac63519541 130 // home positions [um]
Michael J. Spencer 1:f5ac63519541 131 cfg.Value("x.home", &xhome, 0);
Michael J. Spencer 1:f5ac63519541 132 cfg.Value("y.home", &yhome, 0);
Michael J. Spencer 1:f5ac63519541 133 cfg.Value("z.home", &zhome, 100000);
Michael J. Spencer 1:f5ac63519541 134 cfg.Value("e.home", &ehome, 0);
Michael J. Spencer 1:f5ac63519541 135
Michael J. Spencer 1:f5ac63519541 136 // min and max [um]
Michael J. Spencer 1:f5ac63519541 137 cfg.Value("x.max", &xmax, 1E6);
Michael J. Spencer 1:f5ac63519541 138 cfg.Value("y.max", &ymax, 1E6);
Michael J. Spencer 1:f5ac63519541 139 cfg.Value("z.max", &zmax, 200000);
Michael J. Spencer 1:f5ac63519541 140 cfg.Value("e.max", &emax, 1E6);
Michael J. Spencer 1:f5ac63519541 141 cfg.Value("x.min", &xmin, 0);
Michael J. Spencer 1:f5ac63519541 142 cfg.Value("y.min", &ymin, 0);
Michael J. Spencer 1:f5ac63519541 143 cfg.Value("z.min", &zmin, 0);
Michael J. Spencer 1:f5ac63519541 144 cfg.Value("e.min", &emin, 0);
Michael J. Spencer 1:f5ac63519541 145
Michael J. Spencer 1:f5ac63519541 146 // motion settings: enable output state
Michael J. Spencer 1:f5ac63519541 147 cfg.Value("motion.homespeed", &homespeed, 10); // speed during homing [mm/sec]
Michael J. Spencer 1:f5ac63519541 148 cfg.Value("motion.zhomespeed", &zhomespeed, 10); // z-axis speed during homing [mm/sec]
Michael J. Spencer 1:f5ac63519541 149 cfg.Value("motion.speed", &speed, 100); // max speed [mm/sec]
Michael J. Spencer 1:f5ac63519541 150 cfg.Value("motion.accel", &accel, 100); // accelleration [mm/sec2]
Michael J. Spencer 1:f5ac63519541 151 cfg.Value("motion.enable", &enable, 0); // enable output polarity [0/1]
Michael J. Spencer 1:f5ac63519541 152 cfg.Value("motion.tolerance", &tolerance, 50); // cornering tolerance [1/1000 units]
Michael J. Spencer 1:f5ac63519541 153 }
Michael J. Spencer 1:f5ac63519541 154