119 lines
4.1 KiB
C

/*
* This file is part of the canonmanage project.
* Copyright 2022 Edward V. Emelianov <edward.emelianoff@gmail.com>.
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#pragma once
#include <stm32f1.h>
// all data sent in big-endian format
// max length of commands buffer
#define MAXCMDLEN (32)
// connection timeout (100ms): do nothing until this timeout
#define CONN_TIMEOUT (100)
// polling timeout - 2.5s
#define POLLING_TIMEOUT (2500)
// pause after error before next reinit
#define REINIT_PAUSE (5000)
// waiting for starting moving - 0.25s
#define MOVING_PAUSE (250)
// interval of canon_proc calls (10ms)
#define CANONPROC_INTERVAL (9)
// `flooding` interval (250ms)
#define FLOODING_INTERVAL (249)
// answer for cmd "POLL"
#define CANON_POLLANS (0xaa)
// bad focus value - 32767
#define BADFOCVAL (0x7fff)
// flags of 0x90 (144) command:
// Manual focus active
#define CANON_MF_FLAG (0x0080)
// focus dial is active
#define CANON_DA_FLAG (0x2000)
// manual focus is on some edge of range
#define CANON_DE_FLAG (0x0010)
// focus dial moving
#define CANON_DM_FLAG (0x0004)
// maximal
typedef enum{
CANON_LONGID = 0x00, // long ID ???
CANON_ID = 0x01, // lens ID and other info ???
CANON_REPDIA = 0x02, // repeat last diaphragm change
CANON_FSTOP = 0x04, // stop focus changing
CANON_FMAX = 0x05, // set Foc to max
CANON_FMIN = 0x06, // =//= min
CANON_POWERON = 0x07, // turn on motors' power
CANON_POWEROFF = 0x08, // turn off power
CANON_POLL = 0x0a, // busy poll (ans 0xaa when ready or last command code)
CANON_DIAPHRAGM = 0x13, // open/close diaphragm by given (int8_t) value of steps
CANON_FOCMOVE = 0x44, // move focus dial by given amount of steps (int16)
CANON_FOCBYHANDS= 0x5e, // turn on focus move by hands (to turn off send 4,5 or 6)
CANON_DIALPOS0 = 0x6b, // DIALPOSx - something like current transfocator dial (limb) position (not stepper!)
CANON_DIALPOS1 = 0x6c,
CANON_DIALPOS2 = 0x6d,
CANON_DIALPOS3 = 0x6e,
CANON_GETINFO = 0x80, // get information (bytes 0-1 - model, bytes 2-3 - minF, bytes 4-5 - maxF)
CANON_GETREG = 0x90, // get regulators' state
CANON_GETMODEL = 0xa0, // get current lens focus (e.g. 200 == LX200)
CANON_GETSTPPOS = 0xc0, // get focus dial position in steps
CANON_GETFOCM = 0xc2, // get focus position in meters (not for all lenses): Fm = 2.5*b[1] + b[2]/100; Fm previous = next 2 bytes
} canon_commands;
typedef enum{
LENS_DISCONNECTED, // no lens found
LENS_SLEEPING, // do nothing until init
LENS_OVERCURRENT, // short circuit
LENS_INITIALIZED, // initializing process
LENS_READY, // ready to operate
LENS_ERR, // some error occured - reconnect after REINIT_PAUSE
LENS_S_AMOUNT
} lens_state;
typedef enum{
INI_START, // base init done, start F initialization
INI_FGOTOZ, // wait until focus gone to minimal value
INI_FPREPMAX, // prepare to go to max
INI_FGOTOMAX, // go to max F value
INI_FPREPOLD, // prepare to go to old
INI_FGOTOOLD, // go to starting F value
INI_READY, // all OK
INI_ERR, // error on any init step
INI_S_AMOUNT
} lensinit_state;
void canon_init();
void canon_proc();
int canon_diaphragm(char command);
int canon_focus(int16_t val);
int canon_sendcmd(uint8_t cmd);
int canon_asku16(uint8_t cmd);
int canon_writeu16(uint8_t cmd, uint16_t u);
int canon_getinfo();
uint16_t canon_getstate();